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INTRODUCTION 


This report describes the operation and internal structure of the 
computer program FINDS (Fault Inferring Nonlinear Detection System) developed 
by Charles River Analytics Inc. for the NASA Langley Research Center. FINDS 
has been developed to provide detection, isolation, and compensation for 
hardware failures in the flight control sensors and ground-based navigation 
aids [1-4]. 

The FINDS algorithm is designed to provide reliable estimates for 
aircraft position, velocity, attitude, and horizontal winds to be used for 
guidance and control laws in the presence of possible failures in the avionics 
sensors. The FINDS algorithm exploits analytic redundancy between similar as 
well as dissimilar sensors; it can isolate a failure in a duplicate sensor 
configuration and detect a failure even if there is only one sensor of a given 
type in the configuration. FINDS can also detect simultaneous failures in 
navigation aid sensors, arising for instance from ground antenna malfunctions. 
Hence, FINDS can be used to increase the reliability of a sensor configuration 
with a given redundancy. For example, the fail-operational/fail-safe 
capability of a triply redundant voting system can be improved to at least a 
fail-op/fail-op/fail-safe capability. Conversely, FINDS can be employed to 
reduce the hardware redundancy requirements for a given reliability figure. 
As an example, FINDS can be used to replace a triply redundant voting system 
with dual redundancy while maintaining the overall reliability of the system. 

The FINDS algorithm consists of 1) a no-fail filter (NFF), which is an 
extended Kalman filter (EKF) based on the assumption of no sensor failures and 
which provides estimates for aircraft states, horizontal winds, and normal 
operating sensor biases; 2) a set of test-of-mean detection tests implemented 
over moving windows of the NFF residuals; 3) a bank of first order filters 
activated upon failure detection to estimate failure levels in individual 
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sensors; and 4) a decision function which isolates the failed sensor by 
selecting the most likely failure mode depending on the likelihood ratios. 
When a sensor failure is detected and isolated, the algorithm is restructured 
to eliminate the failed sensor from further processing and to remove the 
accumulated effects of the sensor failure on the NFF. Failure identification 
decisions are monitored with the use of a healer algorithm; sensors falsely 
identified as failed or sensors recovered from failures are restored to the 
system. 

The FINDS algorithm was developed with the use of a digital simulation of 
a commercial transport aircraft (B-737) [1-4]. Flight recorded data for this 
aircraft were used to address the issues of sensor modeling inaccuracies, such 
as time-varying sensor bias and time correlated noise [5-6]. The FINDS 
algorithm was then modified to "fit" the size constraints of a flight computer 
and to meet real-time execution requirements without compromising sensor 
failure detection and isolation (FDI) and state estimation performance [7-10]. 

To meet the real-time execution requirements, the FINDS algorithm has 
been partitioned to execute on a dual parallel processor configuration: one 
based on the translational dynamics and the other on the rotational 
kinematics. In addition, a new hierarchical failure isolation strategy has 
been developed, replacing the multiple hypothesis test in the earlier 
versions. Finally, a multi-rate implementation of the FINDS algorithm has 
been implemented to further increase execution speed. 

The outline of the report is as follows. An overview of the FINDS 
algorithm is given in the next section. The implemented equations are given 
in detail in Section 3. Section 4 contains the flow charts for the key 
subprograms. The input and output files are discussed in Section 5. Program 
variable indexing convention is presented as tables in Section 6. Subprogram 
descriptions are presented in Section 7. Finally, Section 8 contains the 
common block descriptions used in the program. 
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2 . 


FINDS ALGORITHM OVERVIEW 


Given a configuration of avionics sensors on an aircraft, the FINDS 
algorithm generates fault tolerant estimates for the vehicle states as 
required by the flight control, guidance, and navigation systems in the 
presence of possible sensor failures. The desired qualities of FINDS are 1) 
use of analytical redundancy concepts to minimize hardware replication 
requirements; 2) timely detection of sensor failures; 3) ability to detect all 
types of sensor failures; 4) acceptable false alarm/detection probability 
performance; 5) ability to recover from false alarms; and 6) minimal 
computational complexity to permit real time operation on flight qualified 
computers. 

The FINDS algorithm baseline structure is shown in Figure 2.1. The 
replicated sensor measurements are separated according to their function in 
the no-fail filter. That is, accelerometer and gyro measurements are used as 
input sensors to integrate the vehicle point mass equations of motion, and the 
remaining sensors (MLS, IAS, and IMU) are used as measurement sensors. The 
input sensors are processed in selection logic, and similar measurement 
sensors are averaged to reduce the overall complexity of the computations 
without a loss of generality. 

The NFF shown in Figure 2.1 is an EKF which is implemented on the 
assumption of no sensor failures. The EKF development is based on discrete 
time difference equations for the vehicle equations of motion. The NFF 
provides estimates for the aircraft position, velocity, attitude, and 
horizontal winds, and estimates for the normal operating biases associated 
with a specified subset of the input and measurement sensors. 
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The formulation yields a computationally efficient EKF implementation in 
which the input sensors are integrated into the NFF without closed loop 
filtering. Only one set of input sensors and the average of the measurement 
sensors are used. The remaining replicated sensors are held in standby and 
inserted as failures are detected and isolated. A decomposition procedure 
based on the separated EKF algorithm provides the EKF filter gains [ll]-[12]. 

The NFF also generates a residual sequence for the averaged measurements, 
as seen in Figure 2.1, and a detection test is performed on these residuals 
over a moving window. The length of the moving window is different for input 
sensors and measurement sensors. A test of mean is compared to a 
predetermined threshold to determine a sensor failure. If a sensor failure is 
detected, the bank of detectors is run using the saved residuals in the 
corresponding moving window memory. The failure levels are estimated and the 
failure is isolated depending on the computed likelihood ratios. 

When a failure is isolated, a reconfiguration algorithm is used to 
restructure the FINDS algorithm [13]. When a gyro or accelerometer (input 
sensor) fails, the faulty sensor is replaced. If there are no more valid 
sensors of that type, the NFF is restructured, provided it is able to function 
with the remaining set of sensors. When a measurement sensor fails, the 
isolated sensor is flagged to be inactive, and appropriate changes are made in 
the NFF noise statistics; also, the NFF is collapsed to accommodate the loss 
of all the sensors of a given type. The reconfiguration block also functions 
to reinitialize the NFF, detectors, and likelihood ratios following 
identification of a failure. 

To recover from false alarms, each failed sensor is given a healing test. 
Input sensors are tested by comparison with sensors of the same type used by 
the NFF. A failed measurement sensor is tested with the NFF estimate of that 
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sensor. These are binary hypothesis tests conditioned on the decision rule 
that the sensor currently in use is healthy. 

The NFF state estimates are initialized using the first iteration of the 
flight data, which includes MLS azimuth, elevation, and range, IAS, and IMU 
pitch, roll, and yaw measurements, to compute the aircraft position, velocity, 
attitude, and horizontal winds in the runway frame, shown in Figure 2.2 as 
required by the NFF. 



6 






3. 


FINDS ALGORITHM IMPLEMENTATION 


The interactive version of FINDS suitable for operation in a simulation 
environment was developed on a DEC VAX 11/780 using FORTRAN 77 under the VMS 
operating system. The flight data driven version of FINDS suitable for 
operation using either flight recorded or simulation generated sensor data was 
developed on Charles River Data Systems Universe 68/35 using FORTRAN 77 under 
the UNOS operating system, and SUN 3/160 using FORTRAN 77 under SunOS 
operating system. Several modifications have been made to the interactive 
version of FINDS to reduce the size and increase the speed of the algorithm, 
and to improve state estimation and sensor FDI performance. The composite 
version, FINDSCMP, of FINDS incorporates these changes, in particular, the 
hierarchical isolation strategy and multi-rate implementation. In addition, 
the FINDS algorithm has been partitioned into two parts for a parallel 
processing architecture: FINDS1 processing the sensors related to rotational 
kinematics and FINDS2 processing the sensors related to the translational 
dynamics. The partitioned version of FINDS has been ported onto a dual- 
processor configured ROLM 1666 flight computer using ROLM FORTRAN 66 compiler 
under the ROLM Real Time Operating System. A DMA local data communication 
link has been used for communication among the processors. In this section, 
the implemented equations for FINDSCMP, FINDS1, and FINDS2 are described. The 
execution flow of the main program is illustrated in Figure 3.1. 


7 




Figure 3.1: FINDS Main Program Execution Flow 
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FINDSCMP (Composite Version) 
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READFL : read the NFF input sensors u^(k) , and the NFF measurement sensors 
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INITXF : Compute the NFF initial state estimates using the first iteration of 

flight data. Denoting the aircraft position in the MLS frame by r , 
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where (x , 
oe 

MLS frame. 


Y oe' 


z ) represent the coodinates of the elevation antenna in the 
oe 


r (k ) = x- r (k ) 
x o M xm o 

r (k ) = y + r (k ) 
y o M ym o 

r (k ) = z - r (k ) 
z o M zm o 

where (« M » Y M » z M > are the azimuth/range antenna coordinates in the runway 
frame. 


W = y sp <k 0 ) ' cos<Y « (k 0 ))#a>s( V k 0 >> + vv 

tyV = V k o ),COS(y « <k o )) - sin<y / k o )) + w 

f Z (k o ) = ■ y sp (k o ) ' sin(y « <k o )> 

W = 0 

w (k ) = 0 
y o 

The initial estimates for the aircraft attitude are obtained by averaging 


the replicated IMU measurements: 

♦<V ■ <V k o> * V k o ))/2 
*< k o> ■ <VV ♦ V#< k o > >/2 

*(k > = <y‘<k ) ♦ y! (k ) )/2 - 

where ^ is the runway yaw, fixed for the given runway configuration. 
R 


SUMIH : (i) compensate rate-gyros for earth's rotation effects 

(ii) average inputs and compensate for biases: 

u C (k) + u?(k-l) . 

u i (k) = — ^ b^k-1) 

where c denotes the current active replication 


EKFHK2) : (i) UPDB — » update input transition matrix B(x(k-1)) 
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B(x(k-1))= 


A 2 / 2 
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T GB (i(k-l)) 
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where the transformation from the body axes into the ground frame is computed 
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c,s, and t are abbreviations for the cosine, sine and tangent functions, 
respectively. The matrix T__ relating the body rates to the Euler angles is 
computed according to; 
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where sc is the abbreviation for the secant function. 

(ii) UPDQ — » update process noise covariance Q(x(k-1)) 
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where is the covariance for the accelerometer sensor noises given by 
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V = 
a 


r o 2 

ax 

0 

0 


0 

2 

j 

ay 
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0 

0 
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j 

az 


where o , o , a are the accelerometer sensor noise standard deviations, 
ax ay az 

is the covariance for the rate gyro sensor noises given by: 


rg 


V (1) 
rg 

0 

0 


V rg (2) 


0 

0 


V 3 > 


with 


V (1) = o' + SPM * (AQ 2 + AR 2 ) + SCF * AP 2 

rg p 

V (2) = o 2 + SPM * (AP 2 + AR 2 ) + SCF * AQ 2 

rg q * 

V (3) = o 2 + SPM * (AP 2 + AQ 2 ) + SCF * AR 2 

rg r 


where o^, o^, a f are the rate gyro measurement noise standard deviations; AP, 
AQ, AR are the averaged p, q, r measurements passed through symmetric limiters 
with thresholds 4 deg/s, 1 deg/sec, and 2.5 deg/sec: 


u pm 1 (k) + pm 2 (k) 
AF ” 2 


. gmjoQ_l qm 2 (k) . ^(k) -I- rro 2 (k) 

i ay - 2 * ax — 2 


where SCF in the rate gyro scale factor error variance, and SPM is the sum of 
SCF and rate gyro misalignment error variances. 

The wind model system matrix is given by 


A W = 


T 


W 


r 


VH 

where r is the time constant associated with the wind model, 
w 
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(iii) Compute prediction error covariance via: 

P # (k/k-1) = A * P„ (k-l/k-1) * A T + Q(x(k-1) ) 
where A is constant state transition matrix given by 


I AI 0 0 

0 10 0 


A = 


10 


0 10 

0 0 e A w A 


BLEND( 2) : (i) Compute single stage prediction: 

A A A 

x(k/k-l) = A * x(k-l) + B(x(k-1) ) * u(k) 

(ii) Update single stage prediction for measurements UPDH * 

A 
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z e/ o M z E e/ 
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j 27 n O aZ 

rn 

where (x u , y u , z ) and (x„ f y_, z_) are the azimuth and elevation antenna 

M M M E E E 

positions in the runway frame, o , o , and a are the averaged MLS sensor 

az e-c rn 

noise standard deviations, and are single stage predictions for the 

aircraft range from the azimuth and elevation antennas given by: 


f (k/k-1) = /Tr 
az 
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where o is the averaged IAS sensor noise standard deviation. 
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-> 9 O 
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0( k/k-1) 


h (x(k/k-l) ) = y_ (k/k-1) = — 

6 0 °e 

h ? (x(k/k-l) ) = y^(k/k-l) = *(k/k-l) 

where o., o n , o, are the averaged IMU sensor noise standard deviations. 

<p 0 \p 


SUMOUT 


y .00 + y^OO 

yj (k) = - 1 2 ~~* 
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(ii) Compute the bias-free NFF gain: 

K x (k) = P # (k/k-1) * [H * P # (k/k-1) * H T + R(k)]"‘ 
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(iii) Compute the bias-free HFF single stage prediction error 
covariance: 

P,(k/k) = [I - K * H] * P # (k/k-l) * [I - K * H] T + 

K * R(k) * K T 
x x 

where R(k) = diag {l/c^} 

BIASF( 1) : (i) Update bias observation matrix: 

(^(k) = H * [A * V b (k-1) + B]+ D 

(ii) Update bias propagation matrix: 

V. (k) = [I - K * H] * A * V. (k-1) + [-B + K * (H * B - D)] 
b x b x 

(iii) Compute the NFF bias gain: 

lyk) = P b (k-1) * c£(k) + [C b (k) * P b (k-1) * C b (k) + R^k)]"* 

where R, (k) = [H * P„(k/k-l) * H T + R(k)] from EKFNl(l) 
b • 

(iv) Compute the HFF bias estimation error covariance: 

P b (k) - [I - K b (k) * C fa (k)] * P b (k-1) 

BLEND( 1) : (i) Compute averaged measurement residuals: 

r(k) = y(k) - h(x(k/k-l)) 

(ii) Update state estimate: 

x(k) = x(k/k-l) + [K (k) + V, (k) * K. (k) ] * r(k) 

x b b 

(iii) Update bias estimates: 

b(k) = b(k-l) + ^(k) * r(k) 

DESCMP : Evaluate expanded measurement residual and store in moving window 

y i /o i ' ^<*<^-1))' 
r (k) = LyJ/°i - h i (x(k/k-l) ) 

DET01 : ( i) Compensate measurement residual covariance inverse RTIHV using 

sensor noise parameters for window 01 
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(ii) Compute the likelihood ratio for moving window 01 
LRTOl(K) = r T (k) * RTINV 01 * r(k) 

If LRT01 < threshold^, then no measurement sensor failure 

else ISOLATE (01) 

DET05 : ( i) Condensate RTIHV for moving window 05 

(ii) Compute measurement residual average for moving window 05: 

l k 

f os (k> = 5 l r< 3> 

UD 3 j=k-4 

(iii) Compute likelihood ratio LRT05 for under 05 
LRT05(k) = ?J 5 (k) * RTIHV 05 * r Q5 (k) 

If LTR05 < threshold-,., then no sensor failures 

Uj 

else ISOLATE (05) 


DET10 : ( i) Conpensate RTINV for window 10 

(ii) Compute measurement residual average for moving window 10 

W k> ' IT . I r<3) 

3=k-9 

(iii) Compute likelihood ratio LRT10 for moving window 10 
LRT10(k) = r^ Q (k) * RTINV 10 * r 1Q (k) 

If LTR10 < threshold^, then no sensor failures 

else ISOLATE (10) 

ISOLAT (w) : (i) 

PXF(k) = 
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where 


P (k) = P (k/k) + [A * VB(k) + B(x(k-1)] * P. (k/k) * [A * VB(k) + B(x(k-1) ] T 

X O D 

P xb (k) = [A * VB(k) + B(x(k-1) ] P b (k/k) 

P b (k) * p b (k/k) 

(ii) Compute inverse of innovation covariance 
R -1 (k) ■ {[H 6] * PXP(k) * [H 5] T + [r Ol}" 1 

[o rJ 

R = diag [<o dw / 0i >**2] 

(iii) Compute failure observation matrix: 


C i (k,x(k)) = [H 6] |a 

[H 5] * [^(iUk-l))] + D i (l/o i 


■B(x(k-1)) 

* 

V ix (k-i)- 

I 




(iv) Compute failure propagation matrix 


f V ix (k) l 

v ib (k) . 


I o' 


K 0 (k)' 

[H 6] 

, = ;; 

0 I. 


K b (k) 




-B(x(k-l))l fv. (k-l)l . r-B.(x(k-l))l 

1 J |vJJ(k-l)J + L 1 o J 


|K (k)l |[H 5] T-B. (x(k-D)l + D. (l/o.) 

' lK°(k)J | l 1 0 J 11 

(v) Compute failure level estimates kl (k) = m^(k-l) + G^(k) * RES(k) 
where - 

RES(k) = [r o (k) —C L lk) * m^k-l)] 

G^k) = [C^tk) * R _1 (k)]/P i (k/k) 

P i (k/k) = P i (k-l/k-l) + C. T (k> * R(k)' 1 * C i (k) 
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(vi) Compute likelihood ratios 

o^k) = RES T (k> * R _1 (k) * RES(k) + a^k-l) 

NOTE : Steps (iii) --> (vi) are performed in loop 'w' number of times 

depending on which window has detected failure. 

C i (0) = V i (0) = P i (0/0) = 0 , o i (0) = -12 * in (Priori^ 

DECIDE : Find the minimum a and check failure level constraint nn > l.cr 

==> isolate failed sensor 

RECOHF (-1) : Reconfigure system for any new 'failed' sensor 

Check if system can operate with remaining set — > else ABORT 

GTOI : i) compute a/c latitude & longitude 

(ii) compute rate-gyro compensation terms. 

(iii) compute gravity vector 

End of Time k ' 


FINDS1 (Rotational Kinematics) 


Number of states, NX = 3 

A T 

State vector, x = [<t>, 6, 4/] 

Number of biases, NB = 3 

* * A * i» 

Bias vector, b = [b , b , b ] 

p q r 

Number of measurement types, NY = 3 
Measurement vector, y = [IMU., IMIK, IMU,] T 

(pay/ 

Number of inputs, NU1 = 3 
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T 

Input vector, u = [p, q, r] 

New Time Iteration Start: time k' 

READFL : Read the NFF input sensors u?(k), and the NFF measurement sensors, 

y j(k) , i=l,2,3, j = 1,2,3; n = 1,2 

EKFN1( 2) : UPDG — * Update input transition matrix B(x(k-1): 

The differences from FINDSCOMP: 

B(x(k-1) ) = A • T ER (x(k-l)) 

and the only other difference from FINDSCMP: 

A = I 

EKFNl(l) : 

The differences from FINDSCMP are the following measurement partials: 

o ■ 

0 

v 

FINDS2 : (Translational Dynamics) 

Number of states, NX = 8 

State vector, x=[r,r,r,f,r,r,w,w] T 

x y z x y z x y 

Number of biases, NB = 3 

Bias vector, b = [b , b , b ] 

ax ay az 

Number of measurement types, NY = 4 

T 

Measurement vector , v = [MLS . MLS MLS , IAS] 

1 az # e^ rn 


H(x(k-1) = 


1 , 0 

<P 

0 Uo e 

0 0 
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Number of inputs, NU1 = 3 

T 

Input vector, u = [ax, ay, az] 

Start of New Time Tick: (time 'k') 

READFL : Read the NFF input sensors u?(k), and the NFF measurement sensors, 

Yj(k) ; i-1,3 ; j=l-4 ; n=l-2 

EKFN1(2) : UPDB — » Update input transition matrix B(x(k-1)): 

The differences from FINDSCMP: 

T A 2 

2 T GB (X(k - 1)) 

B(x(k-1) = A T GB (x(k-l) 

0 

where ^(k-1), F(k-l) and ^(k-1) in the evaluation of T__(x(k-1)) are supplied 

CjD 

by FINDS1. 

I A I 0 
A = 0 I 0 

0 0 A 

w 

EKFNl(l) : The difference from FINDSCMP: The rows corresponding to IMU 

measurements are deleted. 
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4 . 


SUBPROGRAM PLOW CHARTS 


This section o£ the User's Guide contains signal flow and processing 
diagrams of the key subprograms of FINDS. The figures have been arranged in a 
nested sequence of increasing level of detail. Wherever possible, a figure is 
supported by those next in sequence. 



Figure 4.1: Flow Chart for Subprogram NAV 


enter 













Figure 4.2: Flow Chart for Subprogram EKFN1 



! R=diag<l/IREPLF (!)> 


-t -1 

RBF0=[HP1*PF1*HP1 + R] 

GAI'NK=PF1*HP1*RBF0 ± 

PF1 = (I-GAINK*HP1)*PF1*(I-GAINK*HP1) 

■t 

+ GAINK*R*GAINK 



PF 1=AF1*PF1*AF 1|_ 
+EF1*QF1*EF1 







(fente?> 


A 

•l'UP=l>. no 

v -. ? 


f GAINKX=GAINK+VBO*GAINBO | 
RESBO = YF1-HXKP1 
XF1 = XFl + GAINKX*RESBO 

L _ XBFO -XBFO+GAINBO*RESBO 

L 


XF1=AF1*XF1+BF1*UF1 

•.rj.Tzr 


88-004 


i 

Figure 4.3: Flow Chart for Subprogram BLEND 


enter 




3 


{"""compute PXF1 
j forn composite HP1 (CDM|?) 
DETINV=[CDM2*PXFl*COM2 + RFID] 
HPAF -HP1 *AFl 

, HPBF~HP1*BF1 
j rBFlu-GAINKX*HBPD n 

augm=^._ GAINB0 * HBPI) j 


~rr 

| do LODP=UFLVIN 

X 


3 


loop-1 X. 

' 1 A 


yes 


[cbfi-hbpd*vbF( 

null XBFI, VBL CBFI 



PBFI=PBFIC 


[""run INDEX~for all sensors 1 

I VTMP1~HPAF *VBI(INDEX) ; 

I CBFK1NDEX)=CBFI(INDEX)- VTMP1 1 

j compute blender gain VBKINDEX) ! 

| VTHPKl)=CBFIClNDYPKINDRYPCl)),INDEX), l=l,NYF j 

IIMNDRYPOndex y) j 

VTMPKINDEX)= S VTMP1CINDEX)*YSCALECII) | 

call LKF ! 

call LRT 

check INDEX and LOOP | 

call DECIDE I 


88-196 


Figure 4.4: Flow Chart for Subprogram ISOLAT 
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r 


par tition A 


( enter ) 

xX 

no .. ' 

• “<IHFAIL=-1 > 

• •? - ' 

^partition Bj 


r 

r .. . i. - , 

: partition C 

1 | - - J 

l 

L ■ 


•icM D >Nur- > y e s 


L. 


1. 

tit 

:j 


^partition 


([exit]) 


Figure 4.5: Flow Chart for Subprogram RECONF 


[do i=l,NHEALl 

HT 


no 


JCMD>NU1> — 

\ 7 ' 


[jn ou t f < I CM D,iREPLC)=-iJ 




^ bias x yes 
r*~ ^estlnatecP^ 1 -- ~ 




■ zi:~\ 

Hcall* ! 
i setisn i 

| nolsr j 

r; 

[update nyf, 1 
I ino ryp ] 


^ 1 

reset bias""! 
estimator j 




Figure 4.5a: Partition A of Subprogram RECOHF 
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B 


reset healer window 
reset loo LR 
lreplfaCMD)=lreplf<ICMD)-l 
lnoutf<ICMD,IREPLC>=0 


x 


. ' bias ' ^ yes 
estimated^— - 


null appropriate 
colunn of VBO 


n 


I W W \ VII I I I W I 


© 


•8-007 


Figure 4.5b: Partition B of RECONF 



standby \_ n ° 
sensor 


[Tnou t f < iCMDJSNS 5=1 
Ireplf <ICMD)=1 
call rcov 



88-008 



Figure 4.5c: Partition C of RECONF 
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ireplfaCMD»0; 

9 


yes 


tisn~| 




H 

i 


r e alb "1 

1 rcov I 

noisr 

: update NYF,I 

INDRYP | 


88-009 


Figure 4.5d: Partition D of RECONF 


Input output 

sensors sensors 



Figure 4.6: Hierarchical FDI Test 
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Figure 4.7: Isolation Logic 
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5. INPUT AND OUTPUT FILES 

This section contains the descriptions of the input files required by and 
the output files generated by the FINDS program. In addition, the typical 
input design parameters are given in tables. 


FINDS reads in the following files: 

ALGIN.DAT 

o detector thresholds 01, 05, 10 windows 
o process noise SD 

o measurement noise SD 01, 05, 10 windows 
o wind model time contants 

RUNWAY .DAT 

o initial aircraft latitude, longitude position 
o runway orientation relative to north 
o elevation and azimuth/range MLS locations 
o MLS and VOR antenna height above sea level 

FLDAT.NOF 

flight data time history of the NFF input (rate gyro, accelerometer) and 
measurement (MLS, IAS, IMU) sensors, two replications each for a total of 
26 channels of data per record 

Tables 5.1 and 5.2 depict typical values used as design parameters. 

Table 5.1: Design Values for No-Fail Filter Noise Parameters 


Variable 

Noise S.D. 
Per Repl 

Replications 

Used 

Units 

Process Noises 



Acc. Long. 

0.05 

1 

m/s/s 

Acc. Lat. 

0.05 

1 

m/s/s 

Acc. Vert. 

0.05 

1 

m/s/s 

Gyro Roll 

0.05 

1 

deg/s 

Gyro Pitch 

0.05 

1 

deg/s 

Gyro Yaw 

0.05 

1 

deg/s 

x-Wind-rw 

0.10 

N/A 

m/s 

y-Wind-rw 

0.10 

N/A 

m/s 

Measurement 

Noises 



MLS Azim. 

0.06 

1 

deg 

MLS Elev. 

0. 06 

1 

deg 

MLS Range 

6.00 

1 

m 

IAS 

3.00 

2 

m/s 

IKS Roll 

0.25 

2 

deg 

INS Pitch 

0.50 

2 

deg 

INS Yaw 

0.30 

2 

deg 
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Table 5.2 Detector Design Values for Measurement Sensor Noise 

Parameters 


Variable 

Noise S.D. 
per Repl. 

Replications 

Used 

Units 

MLS Azina 

3.00E-02 

1 

deg 

Elev 

3.50E-02 

1 

deg 

Range 

5.50E-00 

1 

m 

IAS 

2.00E-00 

2 

m/s 

INS -Roll 

1.30E-01 

2 

deg 

Pitch 

1.50E-01 

2 

deg 

Yaw 

5.00E-01 

2 

deg 


The following files are written by the program during execution:. 
CHNGREP.DAT 

sensor failure data (index, replication, time) for post processing 
RUNNEW.PLT 

time history of NFF states: position, velocity, attitude, and horizontal 

steady winds 

RUNNEW.TLN 

summary of events during the course of execution 
LRT01.PLT, LRTQ5.PLT, LRT10.PLT 

time history of likelihood ratio and measurement sensor residuals for 
detection windows 1, 5, and 10, respectively 

EXPRES . PLT 

expanded residual time history for those sensors with replications (IAS, 
IMU) 

CTO I ,XF1 

time history of position and velocity states 
SUMIN.UF1 

time history of gravity vector 
IMU.XF1 

time history of attitude states 


Note: 


a) The partitioned algorithms FINDS1 and FINDS2 will read the same input 
as described above for FINDSCMP. In addition, CT0I.XF1 is input for 
FINDS1 and IMU.XF1 and SUMIN.UF1 are both input for FINDS2 
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b) Both FINDSl and FINDS2 write a subset of the output shown above for 
FINDSCMP according to the table shown: 

Algorithm States Residuals 

FINDSCMP ' position, velocity, attitude, MLS, IAS, IMU 

wind, accelerometer bias, gyro bias 

FINDSl attitude, gyro bias IMU 


FINDS2 


position, velocity, wind, 
accelerometer bias 


MLS, IAS 


6 . 


PROGRAM VARIABLE INDEXING TABLES 


This section describes the array indexing convention used in the FINDS 
software. These tables include the following array variables: NFF state and 
measurement vectors, process noise input vector, and the measurement vector. 
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Table 6.1: HFF Absolute State Indexing Convention 


Program Arrays: XF1 



Array Index 

State Variable 

Program Units 

FINDSCMP 

1 

X rw 

ro 


2 

y rw 

m 


3 

z 

rw 



4 

X 

rw 

m/s 


5 

y rw 

m/s 


6 

m 

z 

rw 

m/s 


7 

* 

radians 


8 

e 

radians 


9 

+ 

radians 


10 

\ 

m/s 


11 

y w 

m/s 

FIHDS1 

1 


radians 


2 

e 

radians 


3 


radians 

FINDS2 

1 

x rw 

m 


2 

y rw 

m 


3 

z 

rw 

m 


4 

X 

rw 

m/s 


5 

y rw 

m/s 


6 

z 

rw 

m/s 


7 

x w 

m/s 


8 

y w 

m/s 
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Table 6.2: HFP Absolute Measurement Indexing Convention 


Program Arrays: RESBO, RF1D01, RF1D05, RF1D10, YF1, Y SCALE, INOYP, INOYPI, SIG 

(latter part), SIGD01 (latter), SIGD05 (latter), SIGD10 
(latter), HXKP1 


Array Index 

Measurement Name 

Program Units 

FINDSCMP 

1 

MLS Azimuth 

radians 

2 

MLS Elevation 

radians 

3 

MLS Range 

m 

4 

IAS 

m/s 

5 

IMU Roll 

radians 

6 

IMU Pitch 

radians 

7 

IMU Yaw 

radians 

FIHDS1 

1 

IMU Roll 

radians 

2 

IMU Pitch 

radians 

3 

IMU Yaw 

radians 

FINDS2 

1 

MLS Azimuth 

radians 

2 

MLS Elevation 

radians 

3 

MLS Range 

m 

4 

IAS 

m/s 
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Table 6.3: 

NFF Absolute 

Input 

Indexing Convention 

Program Arrays: UF1, INDUP, XBFO 

Array Index 

Input 

Name 

Program Units 

FINDSCMP 



2 

1 

a x 


m/s 

2 

a 

y 


2 

m/s 

3 

a 

z 


m/s 

4 

p 


radians/s 

5 

q 


radians/s 

6 

r 


radians/s 

FINDS1 


' 


1 

p 


radians/s 

2 

q 


radians/s 

3 

r 


radians/s 

FINDS2 



2 

1 

a 

X 


m/s 

2 

a 

y 


2 

m/s 

3 

a 

z 


m/s 
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Table 6.4: NFF Process Noise Indexing Convention 


Program Arrays: QF1, SIG (former part), SIGD01 (former), SIGD05, (former), 

SFGD10 (former) 


Array Index 

Name 

Program Units 

FINDSCMP 


2 

1 

a 

X 

m/s 

2 

a 

y 

2 

m/s 

3 

a 

z 

2 

m/s 

4 

p 

radians/ s 

5 

q 

radians/s 

6 

r 

radian s/s 

7 

x w 

m/s 

8 

y w 

m/s 

FINDS1 



1 

p 

radians/ s 

2 

q 

radians/ s 

3 

r 

radians/s 

FINDS2 


2 

1 

a 

X 

m/s 

2 

a 

y 

2 

m/s 

3 

a 

z 

2 

m/s 

4 

X 

w 

m/s 

5 

y w 

m/s 
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Program Arrays: IHOBP, 

BTHRSH, 

IHOBPS , IYHAME , IYUNIT, 
FTHRSH, DTMRSH, INDUTF, 

CKVRF , PBF0I, PBFIC, IFAILT 
IREPLF 

Array Index 

Sensor Type 

Program Units 

FINDSCMP 


2 

1 

a 

X 

m/s 

a 

2 

a 

y 

m/s 

3 

a 

z 

m/s 

4 

p 

radian s/s 

5 

q 

radian s/s 

6 

r 

radians/s 

7 

MLS Azimuth 

radians 

8 

MLS Elevation 

radians 

9 

MLS Range 

m 

10 

IAS 

m/s 

11 

IMU 0 

radians 

12 

imu e 

radians 

13 

IMU 4 / 

radians 

FINDS1 



1 

p 

radians/s 

2 

q 

radians/s 

3 

r 

radians/s 

4 

IMU 0 

radians 

5 

imu e 

radians 

6 

IMU 4 / 

radians 

FINDS2 


2 

1 

a 

X 

m/s 

2 

2 

a 

Y 

m/s 

2 

3 

a 

z 

m/s 

4 

MLS Azimuth 

radians 

5 

MLS Elevation 

radians 

6 

MLS Range 

radians 

7 

IAS 

m/s 
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Table 6.6: Replicated Sensor Indexing Convention 


Program Arrays: XBFI, PBFI, RESBI, CBFI, ICNTSN, PRIORI, ALAMDA 



Array Index 

Sensor Type/Repl. 

Program Units 

FINDSCMP 


* 



1 

v n * 

m/s 2 


2 

a -n* 

m/s 2 


3 

a y -n* 

7 * 

m/s 


4 

P -n* 

radian s/s 


5 

q -n. 

radian s/s 


6 

r -» * 

radian s/s 


7 

MLS Azim-n* 

radians 


8 

MLS Elev-Q 

radians 


9 

MLS Rng-n 

m 


10 

IAS-1 

m/s 


11 

IMU 0-1 

radians 


12 

IMU P-1 

radians 


13 

IMU 0-1 

radians 


14 

IAS-2 

m/s 


15 

IMU 0-2 

radians 


16 

IMU P-2 

radians 


17 

IMU 0-2 

radians 


1 A 

1 

p-n* 

radians/s 

2 

q~ n * 

radian s/s 

3 

r-n 

radians 

4 

IMU 0-1 

radians 

5 

IMU 0-1 

radians 

6 

IMU \p-l 

radians 

7 

IMU 0-2 

radians 

8 

IMU 0-2 

radians 

9 

IMU 0-2 

radians 


FINDS2 


1 

a -n 

2 

m/s 2 

2 

X 

a -n 

m/s 2 

3 

a z _n 

m/ s 

4 

MLS Azira-n 

radians 

5 

MLS Elev-n 

radians 

6 

MLS Rng-n 

m 

7 

IAS-1 

m/s 

8 

IAS-2 

m/s 


n refers to the replication currently in use by the HFF (i.e., 1 or 2) 
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Table 6.7: Replicated Measurement Indexing Convention 


Program Arrays: INORYP 


Array Index 

Meas. Sensor 
Type/Repl . 

Program Units 

FIHDSCMP 

* 


1 

MLS Azim-n # 

radians 

2 

MLS Elev-Q 

radians 

3 

MLS Rng-n 

m 

4 

IAS-1 

m/s 

5 

IMU 0- 1 

radians 

6 

IMU 9-1 

radians 

7 

IMU 0- 1 

radians 

8 

IAS-2 

m/s 

9 

IMU <t>-2 

radians 

10 

IMU 0-2 

radians 

11 

IMU 0-2 

radians 


FINDS1 



1 

2 

3 

4 

5 

6 

IMU 0-1 
IMU 8-1 
IMU 0-1 
IMU 0-2 
IMU 8-2 
IMU 0-2 

radians 

radians 

radians 

radians 

radians 

radians 


FINDS2 


. • * 




1 

MLS Azim-n* 

radians 



2 

MLS Elev-Q 

radians 



3 

MLS Rng-n 

m 



4 

IAS-1 

m/s 



5 

IAS-2 

m/s 









c 

n refers to the replication currently in use by the HFF (i.e. # 1 or 2) 






7. SUBPROGRAM DESCRIPTION AND TABLES 

This section contains a description of all subprograms in FINDS. Table 
7.1 is a "quick" reference list of each subprogram and its associated "calls 
to" and "called by" programs. Subsequent paragraphs explain the specific 
function of each subprogram and list its associated common blocks. 


TABLE 7.1 


SUBPROGRAMS 


Called by: 

Name 

Calls to: 

Main program (FINDS/FINDS1/FINDS2) 

READFL 


Main program 

NAV 

HEALR, RECONF , SUMIN, EKFNI, 
BLEND, SUMOUT, BIASF, RESCMP, 
DET01, DET05, DET10, GTOI 

Main program 

INITG 

BUBBL2, INITXF, UPDB, VEQUAL, 
GTOI 

INITG 

INITXF 


NAV 

SUMIN 


NAV 

SUMOUT 


WAV, INITG 

GTOI 


NAV 

EKFNI 

UPDPH, PDMINV, MATIA, MAT3 
V SCALE, MATS, MADD, UPDB, UPD( 
PD3NV1, PMAXB, PMABAT, PMABT2 
PMAPB, PD4NV1 , 

NAV 

BIASF 

VSUB, MEQUAL , MATIA, MATVAC, 
V SCALE, MSUB, MATXYT, MADD, 
PDMINV, PMBEA, PMAXB, PMAXV, 
Y SCALE, PMAMB, PMABT, PMAPB, 
PD3NV1, PD4NV1 

NAV 

BLEND 

MAT LA, MADD, MATVC2, UPDH, 
PMAXB, PMAPB, PMAXV 2 

NAV 

DET01 

MEQUAL, MAT3B, ISOLAT, PMBEA, 
PMVTAV 


DET05 

MEQUAL, MAT3B, ISOLAT, PMBEA, 
PMVTAV 


DET10 

MEQUAL, MAT3B, ISOLAT, PMBEA, 
PMVTAV 

RECONF 

SETISN 


INITG, EKFNI 

UPDB 


EKFNI 

UPDQ 


BLEND 

UPDH 


CLIPSIO, EKFNI 

UPDPH 


NAV 

RESCMP 


DET01, DET05 , DET10 

ISOLAT 

MATIA, PDMINV, VEQUAL, VSUB, 
VADD, LKF, DECIDE, MEQUAL, 
TRANS 2, MATXYT, MADD, MADZ, 
MSUB, MATLN2, MATVEC, LRT 
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Called by 


Name 


Calls to 


ISOLAT 

ISOLAT 


LKF 

LRT 

MAT3B 

ISOLAT 


DECIDE 

VEQUAL, TLOUT, VMPRT, VMPRT2, 

HAV 


RECOHF 

MINIM2, MINIM3 

PNTINV, RCOV, SET1SN, CLPSIO, 

RECOHF 


CLPSIO 

TLOUT, IMEG2, NOISR, MATLN2 , 
RCOV, PWTINV, IMTCG2, CLPSBE, 

RECOHF , 

CLPSIO 

HOI SR 

NOISR, UPDPH 

CL PS 10 


CLPSBE 

ADJTPB, MATCG2, PNTINV, 1MTCG2 

CLPSBE 


ADJTBP 

MATCG3 

PNTINV, IMTCG2 

CL PS 10, 

RECONF 

RCOV 

VMPRT, MATLN2, VMPRT2 , MATLN3 

HAV 


HEALR 

BUBBL2, TLOUT, LRTHLR 

HEALR 


LRTHLR 


Main Program, DECIDE, RECONF, HEALR 
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Includes files ' FINDSCMP. FOR' , 'FINDS1.FOR' , ' FINDS2 .FOR' . 

NOTE ; (a) The exact-dimensioned versions of FINDS1 & FINDS2 are summarized 
here. The documentation for the 'NDIM’ dimensioned versions is 
along the same lines as for FINDSCMP. 

(b) Everything is common to all 3 files except where specified by file- 
name. 

(c) Rotation in this document is as follows: 
func — ► function (of routine) 

refs — * refers (other routines it refers to) 

refby — ► referred by (other routines it gets called by) 

comm — ► common blocks (used in the routine) 

args — ► variables in the argument list 


I. DESCRIPTION OF SUBROUTINES 

name: FINDS/FINDS1/FINDS - (Main Program) 

func: Coordinates the run-time operation of the FINDS algorithm. FINDS1 is 

the rotational kinematics portion and FINDS2 is the translational 
dynamics portion of the composite algorithm. Initializes program 
variables, reads-in first iteration of flight data and initializes 
the filter. The basic run-time loop consists of reading in one 
iteration of flight data (READFL) and passing control to NAV which 
coordinates the FTN/FDI algorithm, 
refs: INITG, READFL, TLOUT, NAV 

comn: FINDSCMP EARTH, MCONCO, SYNC, IMLS, MLSALL, PSIR, CNTROL, ABRTCM 

FINDS 1 — * EARTH, MCONCO, SYNC, IMLS, PSIR, CNTROL, ABRTCM 
FINDS2 — * SYNC, MLSALL, CNTROL, ABRTCM 


name : READFL 

func: Flight data interface routine — reads in the flight data from binary 

data file, assigns data to the various sensor variables ant} converts 
data to program working units (i.e, radians, m, m/s, m/ s ). Also 
checks for data dropouts and "fixes" them by substituting data from 
previous iteration, 
call: Call READFL 

args: None 

refs: None 

refby: FINDS/FINDS 1/FI NDS2 

comm: FINDSCMP * SYNC, MCONCO, RGOUT, LAOUT, AGOUT, ASOUT, MLOUT, NAMES, 

RDLOCL 

FINDS1 —* SYNC, MCONCO, RGOUT, AGOUT, NAMES, RDLOCL 

FINDS2 — * SYNC, MCONCO, LAOUT, ASOUT, MLOUT, FLTIN, NAMES, RDLOCL 


name: NAV 

func: Executive program which coordinates the no-fail filter (NFF ) (or 

fault tolerant navigator FTN) and failure detection (isolation (FDI) 
modules, (see attached flow chart) 
call: Call NAV 

args: None 
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ref s : 

ref by: 
comm: 


name: 
func : 


call : 
args: 
refs : 


ref by: 
comm: 


name: 

func: 


call : 
args : 
ref s : 
refby: 
comm: 


name : 
func : 


HEALR, RECONF , SUMIH, EKFN1 , BLEND, SUMOUT, BIASF, RESCMP, DET01, 
DET10, DET05, GTOI (note: FINDS2 does not contain routine GTOI) 
FINDS/FINDS1/FINDS2 

SYNC, CNTROL, ABRTCM, EKF1, HEALCM, SYSXBO, JUMPCM, DTSYNC, HFCOM 


INITG 

Sets program flags and initializes parameters used in the NFF, FDI 
and reconfiguration modules. The initialization process is in two 
passes; the first pass configures the system dimensions based on 
sensor replications used and also sets the healer parameters. The 
second pass sets the initial conditions for the NFF states and 
initializes the NFF measurement and covariances. 

Call INITG 
None 

FINDSCMP ♦ BUBBL2, VEQUAL, INITXF, UPDB, GTOI 
FINDS 1 — ♦ BUBBL2, INITXF, UPDB, GTOI 
FINDS2 — » BUBBL2, INITXF, UPDB 
FINDS/FINDS1/FINDS2 

SYSX1, SYSYW1, SYSU1, EKF1, EKBFO, SYSXBO, CMPSTF, DETXBI, SYNC, 
MCONCO, FILTRT, INITVL, DETINF, CNTROL, FILTIC, YOBSRV, MAIN1, HEALCM 
In addition, FINDSCMP/FINDS2 contain blocks SIGTAU, ASOUT and FINDS1 
contains block SIG) 


INITXF 

Uses the first iteration of the flight data to compute the NFF state 
initial conditions. A/C position is calculated using a 
reconstruction algorithm from the MLS emasurements . Velocity is 
estimated by resolving the averaged IAS measurement in the 
appropriate axis. A/C attitude initial estimates are obtained by 
averaging the replicated IMU measurements. Initial horizontal winds 
are estimated to be zero. 

Call INITXF 
None 
None 
INITG 

FINDSCMP ♦ FILTRT, MCONCO, EKF1, ASOUT, MLSALL, AGOUT, MLOUT, PSIR 
FINDS 1 » FILTRT, AGOUT PSIR, EKF1 

FINDS2 — ► FLTIN, MLOUT, ASOUT, MLSALL, MCONCO, FILTRT, EKF1 


SUMIN 

Provides a proper set of inputs to the NFF. The input vector is 

formed as follows: 

1) Only on replication of all input sensors is in active mode; the 
second replication is kept either in standby or in failed status. 

2) the input vector, UF1, is formed such that trapezoidal 
integration is performed, i.e., U(k) = 0.5 * {u(k) + u(k-l)] 

3) current estimates of input sensor biases (XBFO) are subtracted 
from UF1 . 

4) FINDSCMP, FINDS 1 ♦ rate gyro measurements are compensated for 

earth and platform rates 

5) FINDSCMP, FINDS2 — ♦ the gravity vector (Gx, Gy, Gz) expressed in 

the G-frame is added to the end_of UF1. 

6) FINDSCMP — » UF1 e [Ax, Ay, Az, P, Q, R, Gx, Gy, Gz] 1 
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FINDS1 — ► UF1 = [P, Q, R] T 

FINDS2 — » UF1 a [Ax, Ay, Az, Gx, Gy, Gz] 

7) In the split versions, FINDS1 generates the gravity vector in 
GTOI which is then transferred over to FINDS2 and used there, 
call: Call SUMIN 

args: None 

refs: None 

ref by: NAV 

comm: FINDSCMP — » MAIN1, RGOUT, LAOUT, EKBFO, SYSU1, SYSXBO, FILTRT, SYNC, 

EARTH, PSIR, TRBER, LATLON, SUMLOC 


name: SUMOUT 

func: Forms a set of measurements (YF1) to be used by the NFF 

1) each sensor replication has an active or failed or standby 
status, and the number of available active replicated 
measurements are averaged 

2) each measurement is normalized by the expected variance of that 
signal (scale factor is set in INITG) 

3) psi measurements are compensated for runway yaw in FINDSCMP and 
FINDS 1 

4) FINDSCMP — ♦ YF1 = [Azim, Elev, Rna, IAS, Phi, Theta, Psi] T 
FINDS 1 — * YF1 = [Phi, Theta, Psi] T 

FINDS2 — * YF2 s [Azim, Elev, Rng, IAS] T 
call: Call SUMOUT 

args : None 

refs: None 

ref by: NAV 

comm: FINDSCMP — » PSIR, ASOUT, AGOUT, MLOUT, SYSYW1, FILTRT, YOBSRV, 

DETXBI 

FINDS 1 — ♦ PSIR, AGOUT, SYSYW1, FILTRT, YOBSRV, DETXBI 
FINDS2 — * ASOUT, MLOUT, SYSYW1, FILTRT, YOBSRV, DETXBI 


name: GTOI (not in FINDS2) 

func: Forms estimates for inertial position, velocity and acceleration, and 

runway acceleration. Also computes the a/c's current longitude and 
latitude along with their rates of change. In addition, coriolis and 
centripetal correction terms for compensating the platform gravity 
force are also computed. [NOTE: in FINDS1, this routine needs the 

a/c position and velocity estimates generated by FINDS2 ] 
call: Call GTOI 

args : None 

refs: None 

ref by: NAV, INITG 

comm: MAIN1, FILTRT, RGOUT, SYSU1, EKF1, TRBER, MCONCO, EARTH, IMLS, PSIR, 

LATLON, PQRDEG, GRVYTC, GTOILC 


name: EKFN1 

func: Represents the bias-free filter portion of the NFF and is implemented 

as an extended Kalman filter (EKF) . Covariance propagation of the 
stabilized normal equations is performed. The state estimates, XF1, 
are not computed in this routine, (see attached flow chart) 
call: Call EKFN1 (Iup) 
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args: Iup — integer in ; update/propagate flag (1 ==> update, 2 = = > 

propagate) 

refs: FINDSCMP — ♦ UPDPH, PDMINV, MAT1A, MAT3 , VSCALE, MAT2 , MADD, UPDB, 

UPDQ 

FINDS 1 — » PD3NV1, PMAXB, PMABAT, VSCALE, PMABT2, PMAPB, UPDB, UPDQ 
FINDS2 — » UPDPH, PD4NV1, PMAXB, PMABAT, VSCALE, PMABT2, PMAPB, UPDB, 
UPDQ 

ref by: NAV 

conn: FINDSCMP — » MAIN2, SYSX1, SYSYW1, SYSU1, EKF1, SYSXBO, SYSYBO, 

FILTRT, TSTORE, CNTROL, EKFBIA, JUMPCM 
FINDS 1 — * MAIN2, SYSX1 , SYSYW1 , SYSU1, EKF1, SYSXBO, SYSYBO, FILTRT, 
CNTROL, EKFBIA, JUMPCM 

FINDS2 — ♦ SYSX1, SYSY1, SYSU1, EKF1, SYSXBO, FILTRT, CNTROL, EKFBIA, 
JUMPCM, EKFBLN, EKFWRK 


name: BIASF 

func: Implements the bias filter portion of the NFF. There are no bias 

filter dynamics; hence no propagation step is required and this 
routine is called only during the update mode of the NFF. 
call: Call BIASF 

args : None 


refs : 

FINDSCMP — ♦ VSUB, MEQUAL, MAT1A, MATVEC, VSCALE, MSUB, MATXYT, MADD 


PDMINV 

FINDS 1 — » VSUB, PMBEA, PMAXB, PMAXV, 

YSCALE, 

PMAMB, PMABT, 

PMAPB 


PD3NV1 

FINDS2 — * VSUB, PMBEA, PMAXB, PMAXV, 

VSCALE, 

PMAMB, PMABT, 

PMAPB, 

refby: 

comm: 

PD4NV1 

NAV 

MAIN1, SYSX1, SYSYW1 , SYSU1, EKBFO, 

SYSXBO, 

GBLEND, YOBSRV , 

FILTRT, 


EKF1, EKFBIA, LRTINV, DETCOV, JUMPCM, 
In addition to the above, 

FINDSCMP — - ♦ MAIN2, SYSYBO, TSTORE 
FINDS 1 MAIN2, SYSYBO, BSFWRK 

FINDS2 BSFWRK 

CNTROL 




name: BLEND 

func: Computes the bias and bias-free state estimates and "blends" them 

together to form the total state and bias estimates. Also forms the 
Kalman gain matrix, (see flow chart) 

call: Call BLEND (Iup) 

args: Iup — integer in ; update/progagate flag (1 ==> update, 2 = = > 

propagate) 

refs: FINDSCMP — ♦ MAT1A, MADD, MATVC2, UPDH 

FINDS1, FINDS2 PMAXB, PMAPB, PMAXV2, UPDH 
ref by: NAV 

conn: SYSX1, SYSYW1, SYSU1, EKF1, EKBFO, SYSXBO, GBLEND, CMPSTF, DETINF, 

FILTRT, JUMPCM 
In addition to the above, 

FINDSCMP — ♦ MAIN2, TSTORE 

FINDS 1 — * MAIN2 

FINDS 2 ♦ EKFBLN, BLNDWK 
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name : DET01 

func: Implements the failure detector of moving residual window 1 sample, 

i.e., the current filter residual. Peforms a Chi-square test on the 
NPF averaged measurement residual RESBO and checks against set 
thresholds to detect failures. Calls isolation routine ISOLAT if 
failure is detected, 
call: Call DET01 

args : None 

refs: FINDSCMP — * MEQUAL , MAT3B, ISOLAT 

FINDS1, FINDS2 — * PMBEA, PMVTAV, ISOLAT 
refby: NAV 

comm: SYNC, SYSYW1, SYSU1, FILTRT, EKBFO, LRTINV, JUMPCM, LRTMAX, DTCT01, 

CNTROL, DETPRI 


name : DET05 

func: Implements the failure detector of moving residual window length 5 

samples. Performs a Chi-square test on the moving average of RESBO 
over the last 5 samples (incl. current residual), 
call: Call DET05 

args : None 

refs: FINDSCMP — » MEQUAL, MAT3B, ISOLAT 

FINDS1, FINDS2 — ♦' PMBEA, PMVTAV, ISOLAT 
refby: NAV 

comm: SYNC, SYSYW1, SYSU1, FILTRT, EKBFO, LRTINV, JUMPCM, LRTMAX, DTCT05, 

CNTROL, DETPRI 


name: PET 10 

func: Implements the failure detection of moving residual window length 10 

samples. Performs a Chi-square test on the moving average of RESBO 
over the last 10 samples (incl. current residual), 
call: Call DET10 

args : None 

refs: FINDSCMP — » MEQUAL, MAT3B, ISOLAT 

FINDS1, FINDS2 — » PMBEA, PMVTAV, ISOLAT 
refby: NAV 

comm: SYNC, SYSYW1, SYSU1, FILTRT, EKBFO, LRTINV, JUMPCM, LRTMAX, DTCT10, 

CNTROL, DETPRI 


name: SETISN 

func: Maintains the value of vector ICNTSN in which the ordering of 

elements corresponds to the absolute replicated sensor ordering 
(Table 6.6). The value of each element is the location in UF1 for 
the input elements (six for FINDSCMP, 3 for FINDS1/FINDS2) , and the 
location in the expanded innovations for the rest of ICNTSN. ICNTSN 
provides a mapping between an absolute indexing scheme and a 
collapsed indexing scheme in the event of failures, 
call: Call SETISN 

args: None 

refs: None 

refby: RECONF 

comm: DETINF, FILTRT, SYSU1, DETXBI 
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name : 
func : 


call : 
args : 
refs : 
ref by: 
conn: 


name: 
func : 


call : 
args: 
refs : 
ref by: 
comm: 


name: 
func : 
call : 
args: 
refs: 
ref by: 
comm: 


name: 

func: 

call : 
args: 
ref s : 
ref by: 
conn: 


name: 

func: 


UPDB 

Updates the discrete input weighting matrix BF1 and also evaluates 
and saves : 

1) sines and cosines of the estimated Euler angles (in FINDS2, these 
are the estimates transferred over from FINDS1 at each 
iteration) . 

2) the transformation from the B to the R frame 

3) the transformation from the R to the E frame (not in FINDS2). 

Call UPDB 

None 

None 

INITG, EKFN1 

MAIN1, TRBER, EULER, SYNC, SYSU1, EKF1, SYSX1 


UPDQ 

Updates the discrete process noise covariance matrix EF1. Assumes 
that UPDB has been called before this routine, hence transformation 
matrices Trb and Ter are current. In addition, for FINDSCMP and 
FINDSl, terms to represent the rate gyro errors due to scale factor 
and misalignment are added to the measurement noise variance. 

Call UPDQ 
None 
None 
EKFN1 

MAIN1, TRBER, SYNC, MCONCO, SYSX1, SYSYW1, UPDQLC 
In addition to the above, 

PINDSCMP — ► SIGTAU, PQRDEG 
FINDSl — » SIG, PQRDEG 
FINDS2 — » SIGTAU 


UPDH 

Updates the nonlinear observations function H, called HXKP1 

Call UPDH 

None 

None 

BLEND 

YOBSRV, SYSX1, SYSYW1, EKF1, SYSU1, EKBFO, SYSXBO 
In addition, 

FINDSCMP, FINDS2 — ♦ MLSALL 


UPDPH (not in FINDSl) 

Updates the partial of H (i.e., HXKP1) w.r.t. XF1, called HP1. Not 
used in FINDSl as HP1 is an identity matrix in that algorithm. 

Call UPDPH 

None 

None 

EKFN1, CL PS 10 

MAIN1, MLSALL, YOBSRV, SYSXBO, SYSU1, SYSYW1, CMPSTF, SYSX1, EKF1 


RESCMP 

Computes the expanded residuals sequence (RESBOC) from the residual 
sequence (RESBO) generated by the NFF. This sequence is the same as 
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call : 

args: 

refs: 

refby: 

comm: 


I 

| 

| name: 

func: 

i 


I 

i 


call : 
args: 

ref s : 


refby: 

conra: 


the one which would have been generated had the filter been driven by 
all replications of the measurement sensors rather than their average 
value. This expanded residuals sequence is used in the failure 
isolation strategy. 

Call RESCMP 

None 

None 

NAV 

EKF1, YOBSRV, SYSYW1, DETINF, FILTRT, SYSU1, DTSYNC 
In addition, 

FINDSCMP — » ASOUT, AGOUT, MLOUT, PSIR 
FINDS1 — * AGOUT, PSIR 
FINDS2 —♦ ASOUT, MLOUT 


I SPLAT 

Implements a bank of first order filters and likelihood ratio 
computers in the isolation strategy. Each filter hypothesizes the 
occurrence of a failure at the beginning of the residual window 
(based on the length of the detector sequence which flagged the 
failure), and estimates the level of a bias jump failure by observing 
the expanded (and saved) residuals sequence over that window. The 
hypothesized failure is assumed to affect the NFF input measurements 
or output measurements only; Thus, a single failure cannot directly 
enter into BOTH an input and an ouput measurment. 

A select subset of all first order filters is activated depending on 
which detector caught the failure. If the detector of window length 
1 sample (DET01) signals the failure, then only the output sensor 
filters are activated. Similarly, if DET10 flags the failure, then 
only the input sensors (and the IAS sensor in the case of 
FINDSCMP/ FINDS 2 ) filters are activated. For DET05 , no such 
assumptions are made and all of the sensors are equally "suspect." 

The first order filters generate a sequence of failure compensated 
residuals which are used by the bank of likelihood ratio computers to 
compute the log likelihood of a singleton sensor failure (or a dual 
simultaneous failure in MLS sensors). 

Subroutine ISOLAT functions as an executive of this bank of filter/LR 
computers. In the current version of FINDSCMP/ FINDS 2, only one 
replication of the MLS sensors is kept active and the other is in 
standby status (like the input sensors); hence, dual simultaneous MLS 
sensor failures are not considered in this routine or in DECIDE, 
(see attached flowchart) 

Call ISOLAT (Iflwin) 

Iflwin — integer in ; length of detector window which flagged the 

failure (has value of either 1 or 5 or 10) 
MAT 1A, PDMINV, VEQUAL , VSUB, VADD, LKF, DECIDE 
In addition, 

FINDSCMP — ♦ MEQUAL, TRANS 2 , MATXYT, MADD, MATZ, MSUB, MATNL2, 
MATVEC, LRT 
DET01, DET05, DET10 

MAIN1, SYSX1, SYSYW1 , SYSU1, SYSXBO, YOBSRV, EKF1, EDBFO, CMPSTF, 
DETXBI, DETINF, DCIDEI, DETYBI , INITVL, FILTRT, DTSYNC, DETCOV, 
DETLC3 
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name: 

func: 


call : 
args: 


refs: 
ref by: 
conn: 


name: 

func: 


args: 


ref s : 
ref by: 
conn: 


name: 

func: 


call: 

args: 

refs: 


In addition, 

PINDSCMP — * MAIN2, TSTORE, MULTDT, DETLC2 

FINDS1 ♦ MAIN2, DETWRK 

PINDS2 —* MULTDT, DETWRK, DETLC2 


LKF 

Provides the failure estimator structure in the isolation strategy. 
Implements a linear Kalman filter using the information form, and 
assumes a scalar state equation. The plant, measurements and filter 
equations are commented in the actual code in each algorithm. 
Generates a set of failure compensated residuals and also a "best" 
estimate of failure level for each suspect sensor. 

Call LKP (Index, Ci, Istart) 

Index — Integer in ; points to particular sensor in question (has 

value based on Table 6.6 indexing) 

Ci — real in ; effective observations matrix (computed in ISOLAT) 
Istart — integer ; location in saved, expanded residual sequence 

RESBOC (has value between 1 and 10 depending on 
current location and Iflwin) 

None 

ISOLAT 

MAIN1, DETINF, DETXBI , DETYBI, DETLC3 


LRT (only in FINDSCMP) 

Computes the log likelihood ratios in the isolation strategy. The 
computations are as follows: 

1) if loop = 1, A = -PH j . This initializes the log likelihood ratio 
A to -ln(PHj) at the start of the detection/decision residual 
window. 

2) SUM I = RES 1 * RTinv * RES 

3) A = 0.5 * SUMI + A) 

Loop — integer in ; detection/decision window step (has values 

from 1 to Iflwin) 

PH j — ► real in ; log of a-priori probability that the j'th sensor 

will fail 

RES — real in ; failure corrected innovations sequence from the 

j’th LKF 

A — real in out ; computed value of log likelihood ratio for j'th 

failure hypothesis. 

MAT3B 

ISOLAT 

MAIN1, DETINF, DETLC3 


DECIDE 

Chooses the most likely failure hypothesis by finding the smallest 
log likelihood ratio of those computed in LRT. For a chosen 
hypothesis, it checks for a minimum accepTable 6.6ailure level, else 
chooses the next likely hypothesis. Also, prints out various user 
messages. 

Call DECIDE (Iflwin) 

Iflwin — integer in ; length of detector window which flagged the 

failure (either 1 or 5 or 10) 

FINDSCMP ► VEQUAL , MINIM2, TLOUT, VMPRT 
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! 
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ref by: 
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func : 
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i 
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I , call: 

args : 


ref s : 

refby: 

conn: 


FINDS1 » VEQUAL, MINIM3, TLOUT, VMPRT2 
FINDS 2 — * VEQUAL, MINIM2, TLOUT, VMPRT2 
ISOLAT 

DETINF, FILTRT, SYSU1, DETXBI, DC IDE I, SYNC, HFCOM, MCONCO, JUMPCM, 
NAMES. 

(In addition, FINDSCMP/FINDS2 — > MULTDT, SIGTAU & FINDS1 — ♦ SIG) 


RECOUP 

Reconfigures the FTS for proper operation (if possible) after 
failures have been detected and isolated, and after sensors heal. 

Call RECONF (Ihfail) 

Ihfail — integer in ; Heal/fail reconfiguration flag where Ihfail 

= 1 for failures and -1 for healings 
PNTIHV, RCOV, SETISN, CLPSIO, TLOUT, IMTCG2 
In addition, 

FINDSCMP — ■ * NOISR, MATNL2 
FINDS1/FINDS2 — * MATNL3 
NAV 

DETINF, FILTRT, SYSU1, DETXBI, DCIDEI, SYNC, SYSXBO, INITVL, EKBFO, 
HEALCM, HFCOM, SYSX1, GBLEND, EKF1, ABRTCM . 

In addition, 

FINDSCMP * MULTDT 

FINDS 1 — * SYSYW1, SIG 

FINDS2 — ♦ MULTDT, SYSYW1, SIGTAU 


CLPSIO 

Used to collapse (or expand) the NFF and its associated data 
structures due to a single failure (or healing) of a measurement 
sensor. This routine is not called when an input sensor is involved. 

1) If Iclps <0 (i.e., collapse NFF) 

* set RF1 (icmd) = 0 

* reset PF1 and PBFO by calling subroutine RCOV 

* decrement NY, NYF 

* update INOYP, INORYP, INOYPI 

* if meas. sensor bias is estimated, collapse bias portion of 
filter by calling subroutine CLPSBE 

2) If Iclps >0 (i.e., expand NFF) 

* call NOISR to set RF1 

* increment NY, NYF 

* update INDYP, INORYP, INOYPI 

* correct partial derivative of h w.r.t. XF1, i.e., HP1 by 
calling UPDPH 

Call CLPSIO (Iclps, Isns, Ireplc) 

Iclps — integer in ; flag used to control col lapse/ expansion of 

NFF where Iclps = 1 ==> collapse & Iclps = 1 
==> expand 

Isns — integer in ; absolute index of sensor (from Table 6.5) 
Ireplc — integer in ; replication of the sensor (1 or 2) 

RCOV, PNTINV, IMTCG2, CLPSBE 

In addition, FINDSCMP — ► NOISR, UPDPH S. FINDS 2 — > UPDPH 
RECONF 

SYSXBO, SYSU1, SYSYW1, DETXBI, DETINF, INITVL, SYSX1 
In addition, FINDS1 — ♦ FILTRT, SIG S. FINDS2 > FILTRT, SIGTAU 
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name: 

func: 

call : 
args : 


ref s : 
ref by: 
comm : 


HOI SR (only in FIHDSCMP) 

Resets the measurement noise covariance terms in the NFF for a given 
sensor type and replication 
Call NOISR (Isns, Ireplc, Imul) 

Isns — integer in ; absolute index of sensor (from Table 6.5) 
Ireplc — integer in ; not used 

Imul — integer in ; flag to use higher noise covariance when 

collapsing the IMU portion of filter, (default 
value = 1, value = 2 when IMU is involved) 

None 

RECONP, CLPSIO 

FILTRT, SYSYW1, SIGTAU, SYSU1 


name : CLPSBE 

func: Responsible for resetting the bias estimator portion of the NFF such 

that a single bias can be added or deleted 

1) calls ADJTBP to determine IBkey and lYkey and to adjust the bias 

pointer vector INOBP, as well as NXB, NUB, NYB, NUB1, and NB 

2) if kflag = -1 (i.e., collapse the bias estimator) 

(a) the IBkey row and column of the bias filter error covariance 
PBFO, is deleted. 

(b) the IBkey column of the bias filter blender gain, VBO is 
deleted 

(c) the IBkey row of the bias estimation vector, XBFO, is 
deleted 

3) if kflag * -1 (i.e., expand the bias estimation) 

(a) PBFO is expanded about the IBkey row and column, and they 
are zeroed out 

(b) the initial bias filter error covariance is loaded into the 
appropriate diagonal element s.t. PBFO (IBkey) = PBFOI 
(Ibias) **2 

(c) VBO is expanded about the IBkey column, and it is zeroed 
out. 

(d) XBFO is expanded about the IBkey column, and zeroed out. 

call: Call CLPSBE (kflag, Ibias) 

args: kflag — integer in ; flag to collapse/ expand the bias filter 

Ibias — integer in ; absolute index of bias type to be added or 

deleted, (from Table 6.5) 
refs: FINDSCMP » ADJTBP, MATCG2 

FINDS 1/FINDS2 ♦ PNTINV, IMTCG2, MATCG3 

ref by: CLPSIO 

comm: SYSXBO, EKBFO, INITVL, GBLEND 

In addition, FINDS1/FINDS2 — + SYSX1, DETXBI , CMPSTF, SYSU1, SYSYW1 


name: ADJTBP (only in FINDSCMP) 

func: Increments or decrements various vector s/ scalar s used by CLPSBE and 

the bias filter, when adding or deleting biases in the estimator 
call: Call ADJTBP (If lag. Index, Irkey, Iykey) 

args: If lag — integer in ; flag indicating addition/deletion of bias (1 

==> add, -1 ==> delete) 

Index — integer in ; absolute index to sensor type of bias to be 

added or deleted (from Table 6.5) 

Irkey — integer out ; pointer to index in reduced bias set 
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Iykey — integer out ; pointer to output type which corresponds to 

bias referred to by index. (If bias is an 
input bias, iykey = 0) Table 6.2 

refs: PNTINV, IMTCG2 

ref by: CLPSBE 

comm: SYSX1, DETXBI, CMPSTF, SYSXBO, SYSU1, SYSYW1 


name : RCOV 

func: Resets the HFF estimation error covariances once a failure has been 

detected and isolated. In particular, it sets, 

PF1 = PF1 + VBI * VBl + (XMI * XMI + 1.0/PMI) 
if PBFO > PBF0I — ♦ PBFO = PBF0I, XBFO = 0 
call: Call RCOV (Vi, Xmi, Pmi, Icmd) 

args: Vi — real in ; blender gain for i'th detector (i = Table 6.6) 

Xmi — real in ; estimate of i'th failure level (i s Table 6.6) 

Pmi — real in ; information matrix for i'th failure (i s Table 

6 . 6 ) 

Icmd — integer in ; absolute sensor type of failed sensor (Table 

6.5) 

refs: FINDSCMP — * VMPRT, MTNL2 

FINDS 1/FINDS2 — * VMPRT2 , MATNL3 
ref by: CLPSIO, RECON F 

comm: SYSXBO, EKBFO, EKF1, CMPSTF, SYSX1, INITVL 

In addition, FINDSCMP -- * MAIN1 


name: HEALR 

func: Manages the operation of the healer logic. Primary function is to 

maintain all sensor failed by the FDI logic and determine if they 
have healed or recovered. Healer decisions are made ONLY at the end 
of a healer decision window (which in our algorithms is set to be 3 
seconds). In FINDSCMP/FINDS1, special logic is employed in order to 
force the IMU's to heal in a coordinated fashion. 

HEALR is operated by computing the running sum, Xsum, of (Xwork- 
Xfail) over the healer window of length Kmxhlr (3 seconds). The 
value of the sum is reset to zero at the start of a new healer 
window; a new healer window is started whenever a new sensor is 
failed by the FDI logic. Xwork and Xfail are defined as follows: 

* for input sensors: 

Xwork = measurement from a currently active replicated sensor of 
the same type as the failed one 
Xfail = measurement from the failed sensor 

* for output sensors: 

Xwork = estimate of the observation obtained from the NFF 
Xfail = measurement from the failed sensor, 
call: Call HEALR 

args : None 

refs: BUBBL2, TLOUT 

In addition, FINDSCMP — * LRTHLR 
ref by: NAV 

comm: SYNC, SYSU1, HEALCM, HFCOM, EKF1, YOBSRV, JUMPCM, NAMES, LOCHEA 

In addition, 

FINDSCMP — ♦ AGOUT, SOUT, MLOUT, RGOUT, LAOUT, PSIR 
FINDS1 — » AGOUT, RGOUT, PSIR 
FINDS2 — * ASOUT, MLOUT, LAOUT 


I 
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name: 


LRTHLR (only in FIHDSCMP ; this routine is integrated into HEALR in 
FINDS1/FINDS2) 

func: Performs a likelihood ratio test to determine if a sensor has healed 

at the end of a healer window. The test is performed as follows: 

1) a maximum likelihood estimate of the normal operational bias is 
computed as. Best = Xsum/Length, where Xsum is the running sum 
from HEALR and Length is the number of samples in the window. 
The estimate is limited by: 

if Best > Bthrsh , Best = Bthrsh 

if Best < -Bthrsh , Best = Bthrsh 

where Bthrsh is the largest expected bias level for this sensor type 
(set in INITG) 

2) a maximum likelihood estimate for a failure level is computed as, 

Fest = Xsum/Length, which is then limited by: 
if Fest > 0 ( Fest < Fthrsh , Fest = Fthrsh 

if Fest < 0 & Fest > -Fthrsh , Fest = -Fthrsh 

where Fthrsh is the smallest expected failure level for this sensor 
type (set in INITG) . 

3) a decision function is evaluated as, 

Xtmp = 2.0 * (Fest -Best) * Xsum + Length * (Best **2 + Fest **2) 

4 ) the value of the decision function is compared to a decision 
threshold, Dthrsh, (set in INITG), and if Xtmp < Dthrsh the 
sensor is declared "healed." 

call: Call LRTHLR (Xsum, J) 

args: Xsum — real in ; sum of (Xwork -Xfail) over healer window 

J — integer in ; absolute index of failed sensor (refer Table 6.5) 
refs: None 

ref by: HEALR 

comm: HEALCM 


name : TLOUT 

func: Prints a coded message corresponding to an event' and the status of 

the NFF estimates in the time-line file, 
call: Call TLOUT (Msg, Imsgl, Imsg2) 

args: Msg -- integer in ; message number corresponding to specific 

events. 

Imsgl, Imsg2 — integers in ; message qualifiers 
refs: None 

ref by: FINDS/FINDS 1/FINDS2 , DECIDE, RECONF , HEALR 

comm: MCONCO, SYNC, EKF1, EKBFO 


DESCRIPTION OF LIBRARY (MATRIX/VECTOR) ROUTINES 


name: VMPRT/VMPRT2 

func: Prints out vectors or diagonals of matrices 

call: Call VMPRT (X, Nr, Nc, Name) «— FINDSCMP 

Call VMPRT2 (X, Nr, Nc, Name, Ndiml) «- — FINDS1/FINDS2 
args: X — real in ; vector or matrix to be printed 

Nr — integer in ; row size of vector/matrix 
Nc — integer in ; column 

Name — character in ; character label to be printed 

Ndiml — integer in ; only in exact dimensioned FINDS1 & FINDS2 — 

max. row dimension of X in calling routine 


56 - 



refs: None 

ref by: DECIDE, RCOV 

comm: None 


name: BUBBL2 

func: Performs a bubble sort on an array of integers where the final 

ordering is smallest to largest, i.e., increasing in value 
call: Call BUBBL2 (Na, n) 

args: Na — integer in out ; array of integers to be sorted 

n — integer in ; length of array Na 
refs: None 

ref by: INITG, HEALR 

comm: None 


name: MATLA/PMAXB 

func: Forms the matrix product Z = XY. No sparseness tests are performed 

and Z, Y can start at same core locations. PMAXB assumes that X, Y, 

Z are exact-dimensioned in the calling routine while MAT1A assumes a 
general 'NDIM' row dimension for all matrices, 
call: Call MAT1A/PMAXB (nl, n2, n3, X, Y, Z) 

args: nl — integer in ; row dimension of X, Z 

n2 — integer in ; col. length of X, row length of Y 

n3 — integer in ; col. length of Y, Z 

X — real m ; input matrix (nl, N2) 

Y — real in ; input matrix (n2, n3) 

Z — real out ; output matrix (nl, n3) 
refs: None 

refby: EKFN1, BIASF, BLEND, ISOLAT, MAT3/PMABAT 

conin: MAT 1A * MAIN1 

PMAXB — -+ None 


name : MAT2/PMABT2 

func: Forms the matrix product Z = XY where Z is symmetric . No sparseness 

tests are done and Z, Y can start at same core locations. PMABT2 
assumes that X, Y, Z are exact-dimensioned in the calling routine 
while MAT2 assumes an NDIM' row dimension for all matrices, 
call: Call MAT2/PMABT2 (nl, n2, X, Y, Z) 

args: nl — integer in ; row dimension of X, Y and col. length of Z 

n2 — integer in ; row dimension of X, Y 

X — real in ; input matrix (nl, n2) 

Y — real in ; input matrix (nl, n2) 

Z — real out ; output matrix (nl, n2) 
refs: None 

refby: EKFN1, ISOLAT 

conin: MAT2 — » MAIN1 

PMABT2 — * None 

name: MAT3/PMABAT 

func: Forms the symmetric matrix product Z = X Y X where Y is symmetric, 

and no sparseness tests are done. PMABAT assumes that X, Y, Z are 
exact-dimensioned in the calling routine while MAT3 assumes an 'NDIM' 
row dimension for all matrices, 
call: Call MAT3 (nl, n2, X, Y, Z) FINDSCMP 
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Call PMABAT (nl, X, Y, Z) < — FINDS 1/FINDS2 (assumes nl = n2) 
args : nl — ► integer in ; row length of X, Z and col. length of Z 

n2 — ► integer in ; row length of Y and col. length of X, Y 
X — ► real in ; input matrix (nl, n2) 

Y — * real in ; input (symmetric) matrix (n2, n2) 

Z — ► real out ; output (symmetric) matrix (nl, nl) 
refs: MAT1A/PMAXB 

ref by: EKFN1 

comm: MAT 3 ♦ MAIN1 

PMABAT — * None 


name: MAT3B/PMVTAV 

func: Forms^a scalar output from the symmetric vector product 

Z = V Y V, where Y is symmetric and no sparseness tests are done. 
PMVTAV assumes that Y is exact-dimensioned in the calling routine 
while MAT3B assumes an 'NDIM' row dimension for Y. 
call: Call MAT3B/PMTAV (nl, V, Y, SOUT) 

args: nl — integer in ; dimension of vector V and row/col. length of 

matrix Y 

V — real in ; input vector (nl, 1) 

Y — real in ; input (symmetric) matrix (nl, nl) 

SOUT — real out ; scalar output 

refs: None 

ref by: DET01, DET05, DET10, ISOLAT, LRT 

comm: MAT3B — * MAIN1 

PMVTAV — ♦ None 


name : MATXYT/ PMABT 

func: Forms the matrix product Z = X Y , no sparseness test on Y PMABT 

assumes that X, Y, Z are exact-dimensioned in the calling routine 
while MATXYT assumes an 'NDIM' row dimension on all matrices, 
call: Call MATXYT/PMABT (nl, n2, n3, X, Y, Z) 

args: nl — integer in ; row dimension of X, Z 

n2 — integer in ; col. length of X, Y 
n3 — integer in ; row length of Y, col. length of Z 
X — real in ; input matrix (nl, n2) 

Y — real in ; input matrix (n3, n2) 

Z — real out ; output matrix (nl, n3) 
refs: None 

ref by: BIASF, ISOLAT 

comm: MATXYT — » MAIN1 

PMABT — * None 


name: MEQUAL/PMBEA 

func: Sets a matrix Y equal to a matrix X, Y = X 

PMBEA assumes that X, Y are exact-dimensioned in the calling routine 
while MEQUAL assumes an 'NDIM' row dimension for X, Y. 
call: Call MEQUAL/PMBEA (nl, n2, X, Y) 

args: nl — integer in ; row length of X, Y 

n2 — integer in ; col. length of X, Y 
X — real in ; input matrix (nl, n2) 

Y — real out ; output in (nl, n2) 
refs: None 
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I 

I 


ref by: BIASF, DET01, DET05, DETIO, ISOLAT 

comm: MEQUAL — » MAIN1 

PMBEA — ► None 


name: TRANS 2 (only in FINDSCMP) 

func: Transpose a matrix, XPOSE = X . Assumes 'NDIM' row dimension for all 

matrices. 

call: Call TRANS2 (nl, n2, X, XPOSE) 

args: nl — integer in ; row length of X, col. length of XPOSE 

n2 — integer in ; col. length of X, row length of XPOSE 
X — real in ; input matrix (nl, n2) 

XPOSE — real in ; output matrix (n2, nl) 
refs: None 

ref by: ISOLAT 

comm: MAIN1 


name: PDMINV/PD3NV1/PD4NV1 

func: Special matrix inverse routine for positive, symmetric, semi-definite 

matrices; uses Cholesky L-u decomposition as an intermediate step. 
PD3NV1 is the special form of PDMINV for 3rd order matrices, used in 
FINDS 1 and PD4NV1 inverts 4th order matrices in FINDS2. 
call: Call PDMINV (n. A, Ainv) 

Call PD3NV1/PD4NV1 (A, Ainv) 

args: n — integer in ; order of matrix to be inverted 

A — real in ; input matrix (n, n) 

Aimv — real out ; output matrix (n, n) 

NOTE: PD3NV1 £■ PD4NV1 assume n = 3 & n = 4, respectively, 

refs: None 

ref by: EKFN1, BIASF, ISOLAT 

comm : None 


name: MINIM2/MINIM3 

func: Searches a vector and determines the minimum value and its 

corresponding location. Only those elements of the vector are 
checked which have a corresponding non-zero element in the other 
input vector. 

call: Call MINIM2 (Imactv, V, Npts, Vmin, Nmin) 

Call MINIM3 (Imactv, V, Npts. Nmin) 

args: Imactv — integer in ; input vector (Npts, 1) with 0 or 1 entries 

corresponding to which entries in V to be 
checked. 

V — real in ; input vector (Npts, 1) to be searched 

Npts — integer in ; length of V (i.e., # of elements to be 

searched) 

Vmin — real out ; value of minimum element in V (not in MINIM3 

which outputs only the location) 

Nmin — integer out; location of the minimum element in V 
refs: None 

ref by: DECIDE 

comm: None 
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name: PNTINV 

func: Searches a pointer vector for particular entry. The pointer vector 

is an integer array with monotonically increasing elements. It will 
show how a collapsed vector's elements relate to a standard vector, 
i.e., given the absolute index, this routine reruns the active index 
in the reduced vector . 

call: Call PNTINV (isns, Ipoint, n, index) 

args: isns — integer in ; value searched for in Ipoint (usually in 

absolute index) 

Ipoint — integer in ; pointer vector to be searched 
n - integer in ; length of Ipoint 

index — integer out ; index in Ipoint where isns was found. If 

isns was not found, index < 0 

refs: None 

ref by: RECONF, CLPSIO, ADJTBP 

comm: None 


name: IMTCG2 

func: To add or delete a row in an integer matrix or vector, or to add or 

delete a column in a matrix. I a row or column is added, its 
elements are set to zero. 

args: jflag — integer in ; operation flag where: 

1 — * add row, 2 — ► add column 

-1 — * delete row, -2 — ► delete column 
index — integer in ; pointer to row/column to be added or deleted 
IY — integer in out ; matrix whose 'index' row/column is to be 

added or deleted 

nr — integer in out ; # of rows of Y (incremented or decremented) 
nc — integer in out ; # of columns of Y (incremented or 

decremented) (not used in FINDS1/FINDS2) 

refs: None 

ref by: RECONF, CLPSIO, ADJTBP, (CLPSBE) 

comm: FINDSCMP — * MAIN1 

FINDS1/FINDS2 — ► None (as no column operations are performed) 


name: MATCG2/MATCG3 

func: To add or delete a row/ column in a real' matrix or vector. If a row 

or column is added, its elements are set to zero. MATCG3 assumes 
that the matrix is exact-dimensioned in the calling routine while 
MATCG2 assumes an 'NDIM' row dimension for the matrix, 
call: Call MATCG2 (jflag, index, Y, nr, nc) 

Call MATCG3 (jflag, index, Y, nr, nc, ndiml) 
args: jflag — integer in ; operation flag where: 

1 — ♦ add row, 2 — ♦ add column 
-1 — * delete row, -2 — ♦ delete column 
index — integer in ; pointer to row/ column to be added or deleted 
Y — real in out ; matrix whose 'index' row/column is to be added or 

deleted 

nr — integer in out ; # of rows of Y (incremented or decremented) 
nc — integer in out ; # of columns of Y (incremented or 

decremented) 

ndiml — integer in ; maximum row dimension of Y in calling routine 

(used only in FINDS1/FINDS2 for exact- 
dimensioned matrices) 
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ref s : 

refby: 

comm: 


None 
CLPSBE 
MATCG2 — 
MATCG3 — 


MAIN1 

None 


name: 
f unc: 


call : 
args: 


refs: 

refby: 

comm: 


MATNL2/MATNL3 

Initializes columns nl through n2 of a matrix to zero. In addition, 
if a flag is set, rows nl through n2 can be nulled out, as well. 
MATNL3 assumes that the matrix is exact-dimens ioned in the calling 
routine while MATNL2 assumes an 'NDIM' row dimension for all 
matrices. 

Call MATNL2 (X, nl, n2, ktrig, n3) 

Call MATNL3 (X, nl, n2, ktrig, n3, ndiml) 

matrix whose rows/columns have to be nulled 
first column/row to be nulled 
last column/row to be nulled 
; operation flag: 0 — ♦ only columns 

*0 — ► rows & columns 

# of elements in any row to be nulled (used 
because all column dimensions are exact) . 

; maximum row dimension of X in calling 
routine. (only in exac t -di men s ioned 
FINDS 1/PINDS2) 


X — real in out ; 
nl — integer in ; 
n2 — integer in ; 
ktrig — integer in 

n3 — integer in ; 

ndiml — integer in 


None 

ISOLAT, RECONF, RCOV 
MATNL2 — * MAIN1 
MATNL3 — » None 


name: 

func: 


call: 

args: 


refs : 

refby: 

comm: 


MADD/PMAPB 

Adds two matrices as Z = X + Y. PMAPB (used in FINDS 1/FINDS2 assumes 
that all matrices are exact-dimensioned in the calling routine while 
MADD (used in FINDSCOMP) assumes an 'NDIM' row dimension for all 
matrices. 

Call MADD/PMAPB (nl, n2, X, Y, Z) 
nl — integer in ; row length of X, Y, Z 

n2 — integer in ; column length of X, Y, Z 

X — real in ; input matrix (nl, n2) 

Y — real in ; input matrix (nl, n2) 

Z — real out ; output matrix (nl, n2) 

None 

EKFN1, BIASF, BLEND, ISOLAT 
MADD --- ♦ MAIN1 
PMAPB — -» 


name: 

func: 


call : 
args : 
refs : 
refby: 
comm: 


MSUB/PMAMB 

Matrix subtraction as Z = X - Y. PMAMB (used in FINDS1/FINDS2 ) 
assumes that all matrices are exact-dimensioned in the calling 
routine while MSUB (used in FINDSCMP) assumes an 'NDIM' row dimension 
for all matrices. 

Call MSUB/PMAMB (nl, n2, X, Y, Z) 
refer args. for MADD/PMAPB 
None 

BIASF, ISOLAT 
MSUB — * MAIN1 
PMAMB » 
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name : MATVEC/PMAXV 

func: Performs matrix vector multiplication as V2 = X*V1. PMAXV (used in 

FIHDS1/FIHDS2 ) assumes that the matrix X is exact-dimensioned in the 
calling routine while MATVEC (used in FIHDSCMP) assumes an 'HDIM' row 
dimension for all matrices, 
call: Call MATVEC/PMAXV (nl, n2, X, VI, V2) 

args: nl — integer in ; row length of X, length of V2 

n2 — integer in ; column length of X, length of VI 
X — real in ; input matrix (nl, n2) 

VI — real in ; input vector (n2) 

V2 — real out ; output vector (nl) 
refs: Hone 

ref by: BIASF, ISOLAT 

comm: MATVEC — * MAIN1 

PMAXV -- ♦ Hone 


name: MATVC2/ PMAXV2 

func: Computes matrix-vector-product-sum as V3 = X*V1 + V2 (an extension bf 

MATVEC/PMAXV) 

call: Call MATVC2/PMAXV2 (nl, n2, X, VI, V2, V3) 

args: same as MATVEC/PMAXV with exception of 

V2 — real in ; input vector (nl) 

V3 — real out ; output vector (nl) 

refs: Hone 

ref by: BLEHD 

comm: MATVC2 — * MAIH1 

PMAXV 2 — » Hone 


name : V SCALE 

func: Performs vector scaling as V2 = s*Vl 

call: Call VSCALE (nl, strap, VI, V2) 

args: nl — integer in ; length of vectors VI, V2 

stmp — real in ; scale factor 
VI — real in ; input vector to be scaled 
V2 — real out ; output vector 
refs: Hone 

ref by: EKFH1, BIASF 

comm: Hone 


name: VEQUAL 

func: Equates vectors as, V2 = VI 

call: Call VEQUAL (nl, VI, V2) 

args: nl — integer in ; length of VI, V2 

VI — real in ; input vector 
V2 — real out ; output vector 
refs: Hone 

ref by: IHITG, ISOLAT, DECIDE 

comm: Hone 


name: VADD 

func: Performs vector addition as V3 = VI + V2 

call: Call VADD (nl, VI, V2, V3) 
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args 


refs : 
ref by: 
conm: 


nl — integer in ; length of VI, V2, V3 
VI — real in ; input vector 
V2 — real in ; input vector 

V3 — in out ; output vector (result of addition) 

None 

ISOLAT 

None 


name: 

func: 

call: 

args : 

refs: 

ref by: 

comm: 


VSllB 

Performs vector subtraction as, V3 = VI - V2 
Call VSUB (nl, VI, V2, V3) 
same as VADD 
None 

BIASF, ISOLAT 
None 
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8. COMMON BLOCK DESCRIPTION AND TABLES 

This section contains a list of FINDS program variables as partitioned by 
various common blocks. Table 8.1 is a "short form" list of each common block 
in FINDS and the various subprograms which refer to it. Supporting Table 8.1 
is a detailed description of the variables contained in each block. 


TABLE 8.1 


COMMON BLOCKS 


Common Block 

Referenced by Subprogram(s) 

ABRTCM 

FINDS (main) , NAV, RECON F 

AGOUT 

READFL , INITXF, SUMOUT, RESCMP, HEALR 

ASOUT 

BIASF 

BLHDWK 

READFL , INITG, INITXF, SUMOUT, RESCMP, HEALR 

BNSRT1 

BNSAV1 , BNSAV2 , SORTER 

BNSRT2 

BNSAV2, BNSAV2 , SORTER 

BNSRT2 

BSFWFK 

SORTER 

CMPSTF 

INITG, BLEND, UPDPH, ISOLAT, RCOV 

CHTROL 

FINDS (main), NAV, INITG, EKFNI, BIASF, DFT01, DFT05, DET10 

DCIDEI 

ISOLAT, DECIDE, RECONF 

DETCOV 

BIASF, ISOLAT 

DETIHF 

INITG, BLEND, SFTISN, RESCMP, ISOLAT, BNSAV2, LKF, LRT, DECIDE 
RECONF, CL PS 10 

DETLC2 

ISOLAT 

DETLC3 

ISOLAT, LKF, LRT 

DETPRI 

DETWRK 

DET01, DET05, DET10 

DETXBI 

INITG, SUMOUT, SETISN, ISOLAT, LKF, DECIDE, RECONF, CLPSIO 

DETYBI 

ISOLAT, LKF, LRT 

DTCT01 

DET01, BNSAVI 

DTCT05 

DET05, BNSAVI 

DTCT10 

DET10, BNSAVI 

DTSYNC 

NAV, RESCMP, ISOLAT, BNSAV2 

EARTH 

FINDS (main), SUMIN, GTOI 

EKBFO 

INITG, SUMIN, BIASF, BLEND, DET01, DET05, DET10, UPDH, ISOLAT, 


RECONF, I LOUT, CLPSBE, RCOV, BNSAVI, BNSAV2 

EKFI 

NAV, INITG, INITXF, GT08, EKFNI, BIASF, BLEND, UPDB, UPDH, 
RESCMP, TLOUT, BNSAV2, ISOLAT, RECONF, RCOV, HEALR 

EKFBIA 

EKFBLH 

EKFWRK 

EKFNI, BIASF 

EULER 

UPDB 

FILTIC 

INITG 
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Common Block 


Referenced by Subprogram^ ) 


FILTRT 

FLTIH 

GBLEND 

GRVYTC 

GTOILC 

HEALCM 

HFCOM 

IMLS 

IHITVL 

JUMPCH 

LAOUT 

LATLOH 

LCOM21 

LOCHEA 

LRTINV 

LRTMAX 

MAIN1 

MAIN2 

MCONCO 

MLOUT 

MS ALL 

MULTDT 

NAMES 

PSIR 

PQRDEG 

RDLOCL 

RGOUT 

SIGTAU 

sumloc 

SYNC 

SYSUI 


SYSXI 

SYSXBO 

SYSYBO 

SYSYWI 

TRBER 

TSTORE 

UPDQLC 

YOBSRV 


INITG, INITXF, SUMIN, SUMOUT, GTOI, EKFNI, BIAS, BLEND, DET01, 
DET05, DET10, NOISR, RECONF, DECIDE, SETISN, RESCMP, ISOLAT 

BIASF, BLEND, RECONF, CLPSBE 

GTOI 

GTOI 

NAV, INITG, RECONF, HEALR, LRTHLR 
NAV, DECIDE, RECONF, HEALR 
FINDS (main>, GTOI 

INITG, ISOLAT, RECONF, CLPSIO, CLPSBE, RCOV 

NAV, EKFNI, BIASF, BLEND, DET01, DET10 , DECIDE, HEALR 

READFL, SUMIN, HEALR 

SUMIN, GTOI, BNSAV2 

BNSAV1, BNSAV2, 

HEALR 

BIASF, DET01, DET05, DETIO 
FINDS (main), DET01, DET05, DET10 

INITG, SUMIN, GTOI, BIASF, UPDB, UPDPH, ISOLAT, LKF, LRT, RCOV, 
BNSAV2 

EKFNI, BIASF, BLEND, ISOLAT, BNSAV2 

FINDS (main), READFL, INITG, INITXF, GTOI, DECIDE, BNSAV1, 

BNSAV2, TLOUT 

READFL, INITXF, SUMOUT, RESCMP, HEALR 
FINDS (main), INITXF, UPDH, UPDPH, 

ISOLAT, DECIDE, RECONF 
READFL, DECIDE, HEALR 

FINDS (main), INITXF, SUMIN, SUMOUT, GTOI, RESCMP, HEALR, BNSAV2 

GTOI 

READFL 

READFL, SUMIN, GTOI, HEALR 

FINDS (main), INITG, DECIDE, NOISR 

SUMIN 

FINDS (main), READFL, NAV, INITG, SUMIN, DET01, DET05, DETIO, 
UPDB, DECIDE, RECONF, HEALR, BNSAVI, TLOUT 

INITG, SUMIN, GTOI, EKFNI, BIASF, BLEND, DET01, DET05, DETIO, 
SETISN, UPDB, UPDH, BNSAV2, HEALR, ADJTBP, NOISR, CLPSIO, 

RECONF, DECIDE, UPDPH, RESCMP, ISOLAT 

INITG, EKFNI, BIASF, BLEND, UPDB, UPDH, UPDPH, ISOLAT, RECONF, 
CLPSIO, ADJTBP, RCOV 

NAV, INITG, EKFNI, BIASF, BLEND, UPDB, UPDH, UPDPH, ISOLAT, 
RECONF, CLPSIO, CLPSBE, ADJTBP, RCOV, BNSAV2 
EKFNI, BIASF, RECONF, 

INITG, SUMOUT, EKFNI, BIASF, BLEND, DET01, DET05, DETIO, UPDH, 
UPDPH, ISOLAT, CLPSIO, NOISR, ADJTBP, BNSAV2 
SUMIN, GTOI, UPDB, 

EKFNI, BIASF, BLEND, ISOLAT 

INITG, SUMOUT, BIASF, UPDH, UPDPH, RESCMP, ISOLAT, HEALR, BNSAVI 
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II 


DESCRIPTION OF COMMON BLOCKS 


NOTE: (1) All vector/matrix dimensions are specified here in three separate 

parentheses corresponding to their use in FINDSCMP, FINDS1 and 
FINDS2, respectively. A single parentheses implies that all three 
versions use the same dimensions. 

(2) Notation used is as follows: cont ==> contains (i.e., brief 

description of common block) 
vars ==> variables contained in 
common block 


name: ABRTCM 

cont: System status flag 

vars: iabort — integer, unitless ; program abort flag which is 

activated (i.e., set from 0 to 1) when too many sensors are 
failed by the FDI logic and filter cannot operate with the 
remaining sensor complement . 
ref by: FINDS/FINDS1/FINDS2, RECONF 


name: AGOUT (not in FINDS2) 

cont: IMU sensor measurements from flight data in program units 

vars: Phira — real, radians, (2) (2) (-) ; dual replicated IMU roll 

measurements 

Them — real, radians, (2) (2) (-) ; dual replicated IMU pitch 

measurements 

Psira — real, radians, (2) (2) (-) ; dual replicated IMU yaw 

measurements (w.r.t. North) 

ref by: READFL, INITXF, SUMOUT, RESCMP, HEALR 


name: ASOUT (not in FINDS1) 

cont: IAS measurements from flight data in program units. 

vars: Airsm — real, m/s, (2) (-) (2) ; dual replicated airspeed 

measurements 

ref by: READFL, INITXF, SUMOUT, RESCMP, HEALR 


name: 
cont : 
vars : 

ref by: 


BLNDWK (only in FINDS2) 

Temporary working variable(s) in subroutine BLEND 

Vtmpl — real, mixed units, (-) (-) (8) ; temp, vector 

propagation 


BLEND 


used 


in 


name: BSFWRK (not in FINDSCMP) 

cont: Local working variables/arrays in subroutine BIASF 


vars: CbfO — real, 

Com2 — real, 
Tmpl — real, 
Tmp2 — real, 
Tmp3 — real, 
Tmp4 — real, 
Tmp5 — real. 


mixed 

units. 

(-) 

(3, 

3) (4, 

mixed 

units. 

(-) 

(-) 

(8,8) 

mixed 

units. 

(-) 

(-) 

(8,3) 

mixed 

units. 

(-) 

(-) 

(8,3) 

mixed 

units. 

(-) 

(-) 

(3,4) 

mixed 

units. 

(-) 

(-) 

(4,4) 

mixed 

units. 

(-) 

(-) 

(3,3) 


; bias filter 
observation matrix 
; temporary local matrix 
; temporary local matrix 
; temporary local matrix 
; temporary local matrix 
; temporary local matrix 
; temporary local matrix 
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refby: 


name: 
cont : 
vars : 


refby: 


name: 
cont: 
vars : 


refby: 


name: 

cont: 

vars: 


refby: 


name: 
cont : 
vars : 


refby: 

name: 
cont : 
vars : 


BIASF 


CMPSTF 

Quantities associated with composite NFF (bias free + bias) 
nxb -- integer, unitless ; total states + bias states in NFF 

value = (17) (6) (11) 

Pxfl — real, mixed, (17,17) (6,6) (11,11) ; combined NFF 

estimation error 
covariance 

INITG, BLEND, UPDPH, ISOLAT, CLPSBE/ADJTBP , RCOV 


CNTROL 

Option flag to activate/deactivate FDI logic 

icntrl — boolean, unitless ; false ==> run NFF only 

true ==> run FDI portion of 
algorithm also 

FINDS1/FINDS1/FINDS2 , NAV, INITG, EKFN1, BIASF, DET01, DET05, DET10 


DCIDEI 

Quantities relevant to the LR computations 
Priori — real, unitless, (20) (9) (11) ; 


Alamda — real, unitless, (20) (9) (11) ; 


ISOLAT, DECIDE, RECONF 


and the decision logic 
vector of log of prior 
probabilities of failure 
— one for each sensor, 
ordered by replicated 
sensor index of Table 
6.6 but assumes dual MLS 
replication, 
vector of log 
likelihood of sensor 
failing — one for each 
sensor, ordered by 
replicated sensor index 
of Table 6.6 but assumes 
dual MLS replication. 


DETCOV 

Quantity needed in isolation routine to form total covariance 
Afvb — real, unitless, (17,6) (3,3) (8,3) ; intermediate storage 

matrix which saves 
the computation 
AF1*VB0 + BF1 

BIASF, ISOLAT 
DETINF 

Information pertinent to the bank of first order filters in ISOLAT 
nft — integer, unitless ; total # of replicated sensors 

(considered for FDI) value = (17) (9) 
( 8 ) 

nyf — integer, unitless ; current # of replicated measurement 

sensors value = (11) (6) (5) from Table 
6.7 


67 



ref by: 


name: 

cont: 

vars: 


ref by: 


name: 
cont : 
vars: 


ref by: 


name: 
cont : 

vars : 


refby: 


unitless, (17) (6) (11) 
unitless, (20) (9) (11) 


Inoryp — integer, 
Icntsn — integer, 

Resboc — real, mixed, 

INITG, BLEND, SETISN, 
CL PS 10 


(14,10) (6,10) (8,10) 
RESCMP, ISOLAT, LKF, 


; pointer vector to 
measurement sensor 
type 

; determines if a 
particular sensor 
type/replication is 
being used and which 
element of the 
input/meas. vector 
it corresponds to. 
Null entry implies 
an inactive sensor. 
(Table 6.6) 

; expanded residual 
vector fram the NFF 
saved over the last 
10 iterations 
LRT, DECIDE, RECONF, 


DETLC2 (not in FINDS1) 

Variables relevant to multiple MLS sensor failures 

Dobs - real, mixed, (17,6) (-) (5,6) ; observation matrix to 

generate dual failure 
conditioned residuals 

Best — real, mixed, (6) ; estimated magnitude of multiple 

replicated MLS failure 


ISOLAT 


DETLC3 

Quantities local to the isolation logic which are temporarily stored 
Detinv — real, mixed, (17,14) (6,6) (11,5) ; inverse of expanded 

innovations 

covariance 

Hpaf — real, mixed, (17,11) (-) (4,8) ; computed HP1*AF1 

Hpbf — real, mixed, (17,6) (6,3) (11,3) ; computed HP1*BF1 

Augm — real, mixed, (17,6) (6,3) (11,3) ; intermediate augmented 

matrix 

Hbpd — real, mixed, (17,6) (6,3) 11,3) ; computed HP1*BF1 + D 

Bmghb -- real, mixed, (17,6) (6,3) (11,3) ; BF1 - GAINKX*HP1*BF1 

ISOLAT, LKF, LRT 


DETPRI 

Flag to check if a failure has already been detected in current 
iteration ; hierarchy of detectors is DET01, DET10, DET05 
idfail — integer, unitless ; set to 1 by any detector which flags 

a sensor failure -- remaining 
detectors will be deactivated during 
current iteration (default value = 
0 ) 

DET01, DET05, DET10 
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name: 
cont : 
vars: 

matrix 

refby: 

name: 

cont: 

vars : 


refby: 

name: 
cont : 

vars : 


refby: 


DETWRK (not in FINDSCMP) 

Local working arrays in subroutine ISOLAT 

Vtmpl — real, mixed, (-) (6) (11) ; temporary working vector 
Vtmp2 — real, mixed, (-) (6) (11) ; temporary working vector 
Tmpl — real, mixed, (-) (3,3) (8,8) ; temporary working matrix 

Tmp2 — real, mixed, (-) (6,6) (5,11) ; temporary working matrix 

Tmp3 — real, mixed, (-) (6,6) (5,5) ; temporary working matrix 

Ttap4 — real, mixed (-) (-) (5,5) ; temporary working matrix 

Com2 — real, mixed, (-) (-) (8,3) ; temporary working matrix 

Hpic — real, mixed, (-) (6,6) (5,11) ; composite observation 


Gnkxd — real, mixed, (-) (6,3) (11,4) 
ISOLAT 


augmented NFF oain matrix 
[GAINKX/GAIHBO] 1 


DETXBI 

Quantities associated with the sensor failure isolation & estimation 
logic 

nfmax — integer, unitless ; maximum possible # of sensor types to 

be considered (has value = 13, 6, 7) 
nymax — integer, unitless } maximum possible # of measurement 

sensor types to be considered (has 
value =7, 3, 4) 

xbfi — real, mixed, (20) (9) (11) ; vector of current failure 

level estimates — one for 
each type & replication using 
absolute indexing (Table 6.6) 
Pbfi — real, mixed, (20) (9) (11) ; vector of estimation 

information for each 
estimated failure (ordered as 
per Table 6.6) 

Vbi — real, mixed, (17,13) (6,6) (11,7) ; matrix of blender gain 

vectors 

INITG, SUMOUT, SETISN, ISOLAT, LKF, DECIDE, RECONF , CLPSIO, ADJTBP 


DETYBI 

Observation matrices and compensated residual vectors for the bank 

of filters in the isolation logic 

Resbi — real, mixed, (17,20) (6,9) (11,11) ; matrix of failure 

compensated 
residuals vectors - 
cols . are ordered by 
replicated sensor 
index (Table 6.6) 

Cbfi — real, mixed, (17,13) (6,6) (11,7) ; observation matrix 

where each col. is an 
observations vector 
for a filter. Cols, 
are ordered by 
replicated sensor 
index (Table 6.6) 

ISOLAT, LKF 


- 69 - 



name: 

cont: 

vars: 


ref by: 


name: 
cont : 
vars: 
ratio 


ref by: 


name: 

cont: 

vars: 

ratio 


ref by: 


name: 
cont : 
vars: 


ref by: 


DTCT01 

Quantities associated with the detector of window length 1 sample 

vlrtOl — real, unitless ; Chi-square test failure likelihood 

ratio 

RtiOl — real, mixed, (17,7) (3,3) (4,4) ; NFF innovations inverse 

matrix compensated for 
residual window length 
of 1 sample 

DET01 


DTCT05 

Quantities associated with the detector of window length 5 samples 

vlrt05 — real, unitless ; Chi-square test failure likelihood 

Ravg05 — real, mixed, (7) (3) (4) ; five sample moving window 

average of NFF residuals 
RESBO 

Rsav05 — real, mixed, (7,5) (3,5) (4,5) ; saved RESBO over last 

five iterations (moving 
window) 

Rti05 — real, mixed, (17,7) (3,3) (4,4) ; NFF innovations 

inverse matrix 
compensated for 
residual window 
length of 5 samples 

DET05 


DTCT10 

Quantities associated with the detector of window length 10 samples 

vlrtlO — real, unitless ; Chi-square test failure likelihood 

RavglO — real, mixed, (7) (3) (4) ; ten sample moving window 

average of NFF residuals 
RESBO 

RsavlO — real, mixed, (7,10) (3,10) (4,10) ; saved RESBO over 

last ten iterations 
(moving window) 

RtilO — real, mixed, (17,7) (3,3) (4,4) ; NFF innovations inverse 

matrix compensated for 
residual window length 
of 5 samples 

DET10 


DTSYNC 

Pointer to current location in saved array of NFF expanded residuals 
icurnt — integer, unitless ; [1,10] location in saved RESB0C — 

used in ISOLAT to go back either 5 or 
10 iterations and run isolation logic 

NAV, RESCMP, ISOLAT 
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name: 
cont : 

vars : 


ref by: 


name: 
cont : 
vars: 


refby: 


name: 
cont : 
vars : 


refby: 


name: 
cont : 
vars: 


refby: 


name: 

cont: 


EARTH (not in FINDS2) 

Quantities associated with earth's rotation -- used in GTOI to 
compute a/c latitude, longitude and rate gyro compensation terms 
oraegt — real, radians ; computed WE * TIME to give angular change 

between I -frame and E-frame 
sinet — real, unitless ; sine of omegt 
comet — real, unitless ; cosine of omegt 
re — real, meters ; radius of earth 
we — real, rad/s ; earth rotation rate 
FINDS/FINDS1, SUMIN, GTOI 


EKBFO 

Arrays used in the bias filter portion of the NFF 

XbfO — real, mixed, (17) (3) (3) ; vector of current normal 

operating bias estimates 
(Table 6.3) 

ResbO — real, mixed, (7) (3) (4) ; vector of NFF residuals (Table 

6 . 2 ) 

GainbO — real, mixed, (17,7) (3,3) (3,4) ; Kalman gain for bias 

filter 

PbfO — real, mixed, (17,6) (3,3) (3,3) ; bias filter estimation 

error covariance 

INITG, SUMIN, BIASF, BLEND, DET01, DET05, DET10, UPDH, ISOLAT, 
RECONF , CLPSBE, RCOV, TLOUT 


EKF1 

Arrays used in the bias free portion of the NFF 

Xfl — real, mixed, (11) (3) (8) ; vector of current NFF state 

estimates (Table 6.1) 

Hxkpl — real, mixed, (7) (3) (4) ; vector of NFF observations 

(Table 6.2) 

Gainkx — real, mixed, (17,7) (3,3) (8,4) ; Kalman gain for EKF 

(bias and bias-free) 

Pfl — real, mixed, (17,11) (3,3) (8,8) ; bias free filter 

estimation error 
covariance 

NAV, INITG, INITXF, GTOI, EKFN1, BIASF, BLEND, UPDB, UPDH, UPDPH, 
RESCMP , ISOLAT, RECONF, RCOV, HEALR, TLOUT 


EKFBIA 

arrays common to the bias and bias- 
Ximgh — real, mixed, (17,11) (3,3) 

impl — real, mixed, (-) (3,3) (-) 

Tmp2 -- real, mixed, (-) (3,3) (-) 

RbfO — real, mixed, (-) (-) (4,4) 


EKFN1, BIASF 


free filters 

(8,8) ; saved computed I-GAIN 

*HP1 

; temporary working matrix 
; temporary working matrix 
; saved HP1 * PF2 * HP1 T + R 
computed in EKFN1 and used 
also in BIASF 


EKFBLN (only in FINDS2) 

Working arrays common to subroutines EKFN1 & BLEND 
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temporary working matrix 


vars: 

refby: 


name: 

cont: 

vars: 


refby: 


name: 
cont : 
vars: 


refby: 


name: 

cont: 

vars: 


refby: 


name: 

cont: 

vars: 


Tmp3 — real, mixed (-) (-) (8,4) ; 

EKFN1, BLEND 


EKFWRK (only in FINDS2) 

(forking arrays local to subroutine EKFN1 

Ttapl — real, mixed, (-) (-) (8,8) ; temporary working matrix 
Tmp2 — real, mixed, (-) (-) (8,8) ; temporary working matrix 
Gktmp — real, mixed, (-) (-) (4,4) ; intermediate gain matrix 

calculation 


EKFN1 


EULER 

Sine/cosine values of 
si — real, unitless 
cl — real, unitless 
s2 — real, unitless 
c2 — real, unitless 
t2 — real, unitless 
s3 — real, unitless 
c3 — real, unit less 
UPDB 


a/c Euler angles 
; sine of roll attitutde 
; cosine of roll attitude 
; sine of pitch attitude 
; cosine in pitch attitude 
; tangent of pitch attitude 
; sine of yaw attitude 
; cosine of yaw attitude 


FILTIC 

Variables associated with NFF initial conditions 

Sdpic — real, mixed, (11) (3) (8) ; vector of s .d . of the 

diagonal elements of the NFF 
state initial estimation 
error covariance. 

INITG 


FILTRT 

Pointing vectors used by NFF 

mxrplf — integer, unitless ; max. # sensor replications used in 

the NFF & FDI logic -- currently 
limited to 2. 

Ireplf — integer, unitless, (13) (6) (7) ; vector of sensor 

replications used by 
the NFF (absolute 
sensor indexing) 
(Table 6.5) 

Inoutf — integer, unitless, (17,2) (6,2) (7,2) ; m a t r i x 

indicating 
status of all 
sensors in the 
NFF. Row index 
corresponds to 
absolute sensor 
type and col . 
index is 
replication of 
sensor. 1 ==> 
active, -1 ==> 
standby, 0 ==> 
failed 
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refby: 


name: 
cont : 
vars : 

refby: 


name: 
cont : 
vars: 
refby: 


name: 

cont: 

vars: 


refby: 


name: 
cont : 
vars: 


refby: 


name: 
cont : 
vars : 


INITG, SUMIN, SUMOUT, GTOI, EKFNL, BIASF, BLEND, DET01, DET05, 
DET10, SETISN, ISOLAT, DECIDE, RECON F 


FLTIN (only in FINDS2) 

Vector array of sensor flight data 
Readin — real, mixed, (-) (-) (26) 

READFL, INITXF 


dual replicated sensor 
flight data. 


GBLEND 

NFF blender gain matrix 

VbO — real, mixed, (17,6) (3,3) (8,3) ; NFF blender gain 

BIASF, BLEND 


GRVYTC (not in FINDS2) 

Arrays needed to compute gravity vector which is appended to the 
input vector UFl a 

GRavlc — real, m/s , (3) (3) (-) ; skew symmetric compensation 

terms for runway frame w.r.t. 
inertial frame 

Tlcprt — real, unitless, (3) (3) (-) ; 

GTOI 


GTOILC (not in FINS2) 

Saved local variables in subroutine GTOI 


aloni 

— real. 

radians 

• 

9 

constant longitude offset 


alati 

— real. 

radians 

• 

9 

constant latitude offset 


ticpl 

— real, 

unitless 

9 

constant 

Tic 

term 

in 

transformation 

matrix 

ticp2 

— real. 

unitless 

9 

constant 

Tic 

term 

in 

transformation 

matrix 

ticp3 

— real. 

unitless 

9 

constant 

Tic 

term 

in 

transformation 

matrix 

ticp4 

— real, 

unitless 

9 

constant 

Tic 

term 

in 

transformation 

matrix 

ticp5 

— real, 

unitless 

9 

constant 
Tic . 

term 

in 

transformation 

matrix 

ticp6 

GTOI 

— real. 

unitless 

9 

constant 

Tic 

term 

in 

transformation 

matrix 


HEALCM 

Quantities used by the healer logic 

kcthlr — integer, unitless ; running count of elapsed samples 

since start of current healer 
window; value = [l, 60] 

kmxhlr — integer, unitless ; total # of samples in (i.e., length 

of) healer window; value = 60 

confbd — real, unitless ; log of initial confidence bound (1/19) 

for the healer test 
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bthrsh — real, mixed, (13) (6) (7) ; vector of largest expected 

normal operating biases for 
each sensor type — absolute 
sensor index, Table 6.5 

Fthrsh — real, mixed, (13) (6) (7) ; vector of smallest expected 

failure levels for each 
sensor type (Table 6.5) 

Dthrsh — real, mixed, (13) (6) (7) ; vector of decision 

thresholds to be applied to 
each healer process. Dthrsh 
(i) = 2*Confbd*Phealt (i)**2 
where Phealt contains s.d. 
of expected noise to be used 
only by healers (Table 6.5) 

ref by: INITG, NAV, RECONF, HEALR, LRTHLR 


name: HFCOM 

cont: Quantities common to the healing/failure reconfiguration logic, 

vars: nfail — integer, unitless ; total # of sensors determined to be 

'failed' 

nnfail — integer, unitless ; # of new failures, i.e., incremental 

# of sensors just detected as failed 
in current iteration 

nhealm — integer, unitless ; max. # of sensors which can heal in 

one instant (i.e., dimension of 
Ihealp) 

nheal — integer, unitless ; total # of sensors which the healer 

logic has declared healthy at the end 
of a healer window 

Ifailt — integer, unitless, (13) (6) (7) ; vector containing 

absolute sensor type 
for each failed 
sensor. (Table 
6. 5) Whenever a sensor 
fails, its absolute 
sensor type is added 
to Ifailt -- hence, 
this vector is ordered 
by relative time of 
occurrence of failure. 

Ifailr — integer, unitless, (13) (6) (7) ; vector containing 

replication # for each 
failed sensor -- 
ordered same as Ifailt 

Ihealp — integer, unitless, (10) (6) (7) ; vector containing list 

of failed sensors 
which have healed. 
The value of an 
element is the index 
in If ailt/If ailr of 
the healed sensor. 

ref by: HAV, RECONF, HEALR 
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name: 
cont : 

vars: 


ref by: 


name: 
cont : 
vars: 


ref by: 


name: 
cont : 
vars : 


refby: 


IMLS (not in FINDS 2) 

Quantities associated with earth rotation & thus on MLS frame 
rotation. 

rmagor — real, m ; radius of earth added to mean sea level 

altitude of MLS frame origin 
slat — real, radians ; latitude of MLS frame origin 
slon — real, radians ; longitude of MLS frame origin 
sinlac — real, unitless ; sine of slat 
coslac — real, unitless ; cosine of slat 

Wrws — real, unitless, (9) (9) (-) ; skew symmetric form of 

angular vel . of runway 
w.r.t. inertial frame. 

FINDS/PINDS1, GTOI 


INITVL 


Initial values for the NFF 

Inobps — integer, unitless, (13) (6) (7) ; INOBPS=INOBP at start 

of run (showing which 
sensor biases are to 
be estimated) Table 
6.5 

PbfOi — real, mixed, (13) (6) (7) ; initial s.d. of bias 

estimation error (user units) 
Table 6.5 


Pbfic — real, mixed, (13) (6) (7) 


INITG, RECONF, CLPSIO, CLPSBE, RCOV 


initial s.d. of isolator 
filters error information, 
(user units) (absolute sensor 
index) Table 6.5 


JUMPCM 

Variables for multi-frequency implementation of NFF 
jmpcvx — integer, 


jmpcvb — integer, 
jmpgnx — integer, 
jmpgnb — integer, 
jiter — integer, 
jmdcx — integer, 
jmdcb — integer, 
jmdgx — integer, 
jmdgb — integer, 
NAV, EKFN1, BIASF, 


unitless 

unitless 

unitless 

unitless 

unitless 

unitless 

unitless 

unitless 

unitless 


# of iterations after which bias 
free covariance has to be computed 

# of iterations after which bias 
covariance has to be computed 

# of iterations after which bias 
free gain has to be computed 

# of iterations after which bias 
gain has to be computed 

running counter of iterations 
elapsed time ticks 
mod (jiter, jmpcvx) = 0 
computations 

mod (jiter, jmpcvb) = 0 == 
computations 

mod (jiter, jmpgnx) = 0 == 
computations 

mod (jiter, jmpgnb) = 0 = 
computations 


or 

==> perform 
==> perform 
==> perform 
==> perform 


BLEND, DET01, DET05, DET10, DECIDE, HEALR 
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name: 

cont: 

vars: 


ref by: 


name: 

cont: 

vars: 


ref by: 


name: 

cont: 

vars: 


ref by: 


name: 

cont: 

vars: 

ref by: 


name: 
cont : 
vars: 


refby: 


LAOUT (not in FINDS1) 

Replicated accelfrometer sensor measurements from flight data 
Axm — real, m/s , (2) (-) (2) ; dual longitudinal accelerometer 

2 meas. 

Aym — real, m/s,, (2) (-) (2) ; dual lateral accelerometer meas. 
Azm — real, ro/s , (2) (-) (2) ; dual vertical accelerometer meas. 
READFL, SUMIN, HEALR 


LATLON (not in FINDS2) 

Information regarding a/c latitude and longitude 

alat — real, radians ; current estimate of a/c latitude 

alon — real, radians ; current estimate of a/c longitude 

alatd — real, rad/s ; current estimat of rate of latitude change 

alond — real, rad/s ; current estimat of rate of longitude change 

csalat — real, unitless ; cosine of alat 

snalat — real, unitless ; sine of alat 

GTOI, SUMIN 


LOCHEA 

Quantities local to subroutine HEALR 
nfaill — integer, unitless ; local 
Ifailp — integer, unitless, (20) (9) 

Xsum — real, mixed, (20) (9) (11) ; 


snapshot of 'nfail' 

(11) ; local snapshot of 

' Ifailt' 

running sum over healing 
window length of difference 
between failed sensor and 
"working" sensor. 


Itest — integer, unitless, (3) (3) (-) ; 

Itestp — integer, unitless, (3,3) (3,3) (-) 

Itest2 — integer, unitless, (9) (9) (-) ; 

HEALR 


Local pointer vector for 
IMU healing logic 

; Local pointer to 
store which parts 
of the IMU have 
healed 

pointer vector to check 
that entire IMU heals 
as a unit 


LRTINV 

Saved part of Kalman gain calculations 
by the detectors in the Chi-square test. 
Rtinv — real, mixed, (17,7) (3,3) (4,4) 

BIASF, DET01, DET05, DET10 


from bias filter to be used 

; saved [CBF0*PBF0*CBF0 + 
RBFO] ** -1 


LRTMAX 

Maximum Chi-square test thresholds to trip detectors 
vmaxOl — real, unit less ; max. threshold to trip DET01 

vmax05 — real, unitless ; max. threshold to trip DET05 

vmaxlO — real, unitless ; max. threshold to trip DET10 

DET01, DET05, DET10 
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name: 

cont: 

vars : 


refby: 


name: 
cont : 
vars : 


refby: 


name: 
cont : 
vars: 


refby: 


name: 
cont : 
vars: 


refby: 


name: 
cont : 
vars : 


refby: 


MAIN1 

Provides common dimensioning information for all 2-dimensional 
arrays and a scratch array for temporary use by all routines, 
ndim — integer, unitless ; common row dimension for all arrays, 

value = (17) (6) (11) 
ndiml — integer, unitless ; ndim +1 

Dmfx — real, temporary, (17,17) (6,6) (11,11) ; scratch area 

dimensioned 'ndim 
x ndim' 

INITG, SUMIN, GTOI, BIASF, UPDB, UPDQ, UPDPM, ISOLAT, RCOV, VMPRT, 
MAT1A, MAT2, MAT3, MAT3B, MATXYT, MEQUAL, TRANS 2 , IMTCG2 , MATCG2, 
MAINL2, MADD, MSUB, MATVEC, MATVC2 


MAIN 2 

Provides a temporary scratch area for use by all routines 

Com2 — real, temporary, (17,17) (6,6) (11,11) ; scratch array 

dimensioned 'ndim 
x ndim' 

EKFN1, BIASF, BLEND, ISOLAT 


MCONCO 

Conversion factors from user units to program units & vice versa 

Radian — real, unitless ; conversion factor from degrees to 

radians 

Cnvrf — real, unitless, (13) (-) (7) ; conversion factors from 

program units to user 
units for sensor signals - 
- absolute sensor index. 
Table 6.5 (not used in 
FINDS1 because all 
conversions are radians to 
degrees) 

FINDS/FINDS1/FINDS2 , READFL, INITG, INITXF, GTOI, UPDQ, DECIDE, 

TLOUT 


MLOUT (not in FIND21) 

Replicated MLS sensor measurements from flight data 
Azim — real, radians, (2) (-) (2) ; dual azimuth measurements 

Elem — real, radians, (2) (-) (2) ; dual elevation measurements 

Rngm — real, radians, (2) (-) (2) ; dual range measurements 

READFL, INITXF, SUMOUT, RESCMP, HEALR 


MLSALL (not in FINDS1) 

Information regarding MLS antenna locations. 

Xaz — real, m, (3) (-) (3) ; location of azimuth/DME antenna in 

the runway frame 

Xel — real, m, (3) (-) (3) ; location of elevation/DME antenna in 

the runway frame 

xO — real, m ; x-location of elev. antenna in MLS frame 

xO — real, m ; y- location of elev. antenna in MLS frame 

zO — real, m ; altitude offset between azimuth & elev. antennae 

FINDS/FINDS2, UPDH, UPDPH 
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name: 

cont: 

vars: 


ref by: 


name: 
cont : 
vars: 


ref by: 


name: 
cont : 
vars : 


ref by: 


name: 
cont : 

vars : 


ref by: 


name: 

cont: 


vars: 


MULTDT (not in FINDS1) 

Quantities used in detecting multiple simultaneous failures. 


Priorj — real, mixed, (3) (-) (3) 

Alamdj — real, mixed, (3) (-) (3) 
Resbj — real, mixed, (17,3) (-) ( 

ISOLAT, DECIDE 


; vector of log. of the prior 
probability of more than one 
MLS sensor of the same type 
to fail in the same instant 
(common mode failure), 
(ordered MLS azimuth, 
elevation, range) 

; vector of log-likelihood of a 
multiple MLS sensor failure, 
(ordered same as Priorj) 

,3) ; matrix of multiple MLS 

failure compensated 
residuals vectors. 
Cols, are ordered as 
azim., elev., mg. 


NAMES 

Character variables which are vectors of 
lyname — character *9, (13) (6) (7) ; 

Iyunit — character *5, (13) (6) (7) ; 


sensor names & units 
vector of sensor types. 
Table 6.5 

vector of sensor types. 
Table 6.5 


READFL, DECIDE, HEALR 


PSIR (not in FINDS2) 

Quantities associated with runway yaw 

psiru — real, radians ; runway yaw w.r.t North 

simpsr — real, unitless ; sine of psiru 

cospsr — real, unitless ; cosine of psiru 

FINDS/FINDS1 , INITXF, SUMIN, SUMOUT, GTOI, RESCMP, HEALR 


PQRDEG (not in FINDS2) 

Computed "best" estimate of P, Q, R (in degrees) as average of all 

available rate sensors, including standby equipment 

apdeg — real, degrees ; roll rate estimate ((repl + rep2)/2) 

agdeg — real, degrees ; pitch rate estimate 

ardeg — real, degrees ; yaw rate estimate 

GTDl , UPDQ 


RDLOCL 

Saved local variables in subroutine READFL. In particular, the 
saved variables are current sensor measurements to be used at the 
next iteration and the maximum sensor differences for the data drop- 
out tests. a 

Axmold — real, m/s , (2) (-) (2) ; longitudinal accel. previous 

2 measurements 

Aymold — real, m/s , (2) (-) (2) ; lateral accel. previous 

measurements 
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Azmold — real, m/s , (2) (-) (2) ; vertical accel. previous 

measurements 

Pmold — real, rad/s, (2) (2) (-) ; roll rate gyro previous 

measurements 

Qnold — real, rad/s, (2) (2) (-) ; pitch rate gyro previous 

measurements 

Rmold — real, rad/s, (2) (2) (-) ; yaw rate gyro previous 

measurements 

Aziold — real, rad, (2) (-) (2) ; MLS azimuth previous 

measurements 

Eleold — real, rad, (2) (-) (2) ; MLS elevation previous 

measurements 

Rngold — real, m, (2) (-) (2) ; MLS range previous measurments 

Airold — real, m/s, (2) (-) (2) ; IAS previous measurements 

Phiold — real, rad, (2) (2) (-) ; IMU roll previous measurements 

Theold — real, rad, (2) (2) (-) ; IMU pitch previous measurements 

Psiold — real, ra$, (2) (2) (-) ; IMU yaw previous measurements 

Axmax — real, m/s a ; longitudinal accel. dropout threshold 
Aymax — real, ra/s a ; lateral accel. dropout threshold 
Azmax — real, m/s ; vertical accel. dropout threshold 
Pmax — real, rad/s ; roll rate gyro dropout threshold 
Qroax — real, rad/s ; pitch rate gyro dropout threshold 
Rmax — real, rad/s ; yaw rate gyro dropout threshold 
Azimax — real, rad ; MLS azimuth dropout threshold 

Elemax — real, rad ; MLS elevation dropout threshold 

Rngmax — real, m ; MLS range dropout threshold 
Airmax — real, m/s ; IAS dropout threshold 

Phimax — real, rad ; IMU roll dropout threshold 

Theraax — real, rad ; IMU pitch dropout threshold 

Psimax — real, rad ; IMU yaw dropout threshold 

ref by: READFL 


name: RGOUT (not in FINDS2) 

cont: Replicated rate gyro measurements from flight data 

vars: Pm — real, rad/s (2) (2) (-) ; dual roll rate gyro measurements 

Qm — real, rad/s (2) (2) (-) ; dual pitch rate gyro measurements 
Rm — real, rad/s (2) (2) (-) ; dual yaw rate gyro measurements 
ref by: READFL, SUMIN, GTOI, HEALR 


name: SIGTAU (SIG in FINDS1) 

cont: Design values for noise parameters used by NFF and detectors 

vars: Sig — real, mixed, (15) (6) (9) s.d. of sensor noise used by NFF 

(ordered as input sensors, winds, 
output sensors). Tables D, B 

Tau — real, seconds, (2) (-) (2) ; time constant for horizontal 

winds in wind model used by 
NFF 


SigdOl — 

real. 

mixed. 

(15) 

(6) 

(9) 

; s.d. of sensor noise for 
DET01, ordered same as SIG 

Sigd05 — 

real, 

mixed. 

(15) 

(6) 

(9) 

; s.d. of sensor noise for 
DET05, ordered same as SIG 

SigdlO — 

real. 

mixed, 

(15) 

(6) 

(9) 

; s.d. of sensor noise for 
DET10, ordered same as SIG 


refby: INITG, UPDQ, DECIDE, NOISR 
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name: 

cont: 


vars: 


refby: 


name: 

cont: 

vars: 


refby: 


name: 
cont : 
vars: 


SUMLOC 


Saved local variables in subroutine SUMIN. In particular, the input 
sensor measurements from the current iteration are saved to perform 
trapezoidal integration at the next iteration. 


Ax mo — real, m/s , 

a 

(2) 

(-) 

(2) 

9 

saved longitudinal accel. 
measurements 

Aymo — real, m/s , 
2 

(2) 

(-) 

(2) 

• 

9 

saved lateral accel. 
measurements 

Azmo — real, m/s , 

(2) 

(-) 

(2) 

• 

9 

saved vertical accel. 
measurements 

Pmo — real, rad/s, 

(2) 

(2) 

(-) 

• 

9 

saved roll rate gyro 
measurements 

Qmo — real, rad/s, 

(2) 

(2) 

(-) 

• 

9 

saved pitch rate gyro 
measurements 

Rmo — real, rad/s, 
SUMIN 

(2) 

(2) 

(-) 

• 

9 

saved yaw rate gyro measurements 


SYHC 

Quantities associated with the program timing and synchronization. 

dtime — real, s ; program integration step size ( 1 / 20 ) 

idtime — integer, unitless ; counter incremented at each 

iteration to compute 'time' 

time — real, s ; elapsed time from start of program 
tstart — real, s ; program starting time (default = 0 ) 
tstop — real, 5 ; program final time (estimated) 

dt 22 — real, s ; saved dtirae*dtime /2 

idst05 — real, unitless ; counter to stop/start DET05 after 

system reconfiguration following 
failure/healing . 

idstlO — real, unitless ; counter to stop/start DET10 after 

system reconfiguration following 
failure/healing. 

FINDS/FINDS1/FINDS2, READFL, NAV, INITG, SUMIN, DET01, DET05, DET10, 
UPDB, UPDQ, DECIDE, HEALR, TLOUT 


SYSU1 

Quantities associated with the inputs to the NFF 

nu — integer, unitless ; total # of inputs to NFF including 

gravity inputs (default value = 9,3,6) 
nul — integer, unitless ; total # of inputs to NFF associated 

with an input sensor (i.e, nu -ng), 
value = 6 , 3, 3 

nulpl — integer, unitless ; nul +1 ; = 7, 4, 4 

nulc — integer, unitless ; (nul) - (# of inputs not currently 

active). 

Inoup — integer, unitless (17) ( 6 ) (11) ; pointer vector to 

absolute input 
measurements used by 
NFF (Table 6.3). The 
array index corresponds 
to the location in uFl 
and the value is the 
abs. input meas. type 
index. 
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ref by: 


name: 
cont : 
vars: 


ref by: 


name: 
cont : 
vars: 


ref by: 


name: 
cont : 
vars : 


refby: 


name: 
cont : 


Ufl — real, mixed, (9) (6) (6) ; vector of compensated inputs 

used by NFF (computed in SUMIN) 
INITG , SUMIN , GTOI, EKFN1, BIASF, BLEND, DET01 , DET05 , DET10 , 
SETISN, UPDB, UPDH, UPDPH, RESCMP, ISOLAT, DECIDE, RECONF, CLPSIO, 
NOISR, ADJTBP, HEALR 


SYSX1 

Bias free filter state dimensions and system matrices 

nx — integer, unitless ; total # of states in bias free portion 

of NFF, value = 11, 3, 8 

nxl - integer, unitless ; nx + 1, value = 12, 4, 9 

Afl — real, mixed, (11,11) (-) (8,8) ; constant state transition 

matrix. (Not defined in 
FINDS1 as it is an 
identity matrix there) . 

Bfl — real, mixed, (17,9) (3,3) (8,6) ; nonlinear input 

transition matrix 
(function of states). 

Efl — real, mixed, (17,11) (3,3) (8,8) ; discrete process noise 

covariance matrix. 

INITG, EKFN1, BIASF, BLEND, UPDB, UPDQ, UPDH, UPDPH, ISOLAT, RECONF, 
CLPSIO, ADJTBP, RCOV 


SYSXBO 

Quantities associated with the bias filter portion of the NFF. 
nb — integer, unitless ; current # of biases estimated by NFF (nb 

= nub + nyb), value 6, 3, 3 

nub — integer, unitless ; current # of input sensor biases 

estimated by NFF, value =6, 3, 3 

nyb — integer, unitless ; current # of measurement biases 

estimated by NFF, value =0, 0, 0 
nubl — integer, unitless ; nub + 1, value =7, 4, 4 
Inobp — integer, unitless, (13) (6) (7) ; pointer vector to 

sensor type of each 
bias estimated, 
(absolute sensor index) 
(from Table 6.5) 

NAV, INITG, SUMIN, EKFN1, BIASF, BLEND, UPDH, UPDPH, ISOLAT, RECONF, 
CLPSIO, CLPSBE, ADJTBP 


SYSYBO (not in FINDS2) 

Variables coirmon to subroutines EKFN1 and BIASF 

Rbf 0 - real, mixed, (17), 12) (3,3) (-) ; saved HP1*PF1*HP1 1 + R 

from EKFN1 

CbfO — real, mixed, (17,6) (-) (-) ; bias filter observation 

matrix. 


EKFN1, BIASF 


SYSW1 

Quantities associated with the NFF observation and process noises. 



vars: 


ref by: 


name: 
cont : 
vars: 


ny — integer, unitless ; total # of averaged (or collapsed) 

measurements presented to the NFF, value 
= 7, 3, 4 

nymxi — integer, unitless ; initial max. # of avgd. meas. to NFF, 

value =7, 3, 4 

Inoyp — integer, unitless, (17) (6) (11) ; pointer vector to 

active avgd. outputs 
used by NFF. (array 
index corresponds to 
the elements of the 
measurement array & 
value of each element 
corresponds to 
absolute meas. index.) 
Table 6.2 

Inoypi — integer, unitless, (17) (6) (11) ; inverse mapping of 

Inoyp, i.e., array 
index is abs . meas. 
index and value is 
the corresponding 
index in current 
meas. vector to NFF. 
If a particular meas. 
type is not used, its 
value entry will be 
zero. 

Yfl — real, mixed, (7) (3) (4) ; vector of avgd. meas. used by 

NFF (abs. meas. sensor indexing) 
Table 6.2 

Qfl — real, mixed, (8) (3) (5) ; vector of process noise 

covariances organized by 
absolute input index, Table 6.4 

Hpl — real, mixed, (17,17) (3,3) (4,8) ; effective observation 

matrix for NFF (partial 
of h w.r .t . x) 

RfldOl — real, mixed, (7) (3) (4) ; vector of meas. noise 

covariances used by DET01 
(abs. meas. index). Table 6.2 
Rfld05 — real, mixed, (7) (3) (4) ; vector of meas. noise 

covariances used by DET05 
(abs. meas. index). Table 
6.2 

RfldlO — real, mixed, (7) (3) (4) ; vector of meas. noise 

covariances used by DET10 
(abs. meas. index). 

INITG, SUMOUT, EFKN1, BIASF, BLEND, DET01, DET05, DET10, UPDQ, UPDH, 
UPDPH, ISOLAT, CLPSIO, NOISR, ADJTBP 


TRBER 

Transformation matrices for various reference frames 

Trb — real, unitless, (3,3) (3,3) (3,3) ; transformation matrix 

from body axes into the 
G-frame (for accel. 
inputs) . 
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refby: 


name: 
cont : 
vars : 

refby: 


name: 
cont : 
vars : 


refby: 


name: 
cont: 
vars : 


refby: 


Ter — real, unitless, (3,3) (3,3) (-) 


Tic — real, unitless, (3,3) (3,3) (-) 


SUHIN, GTOI, UPDB, UPDQ 


matrix relating the body 
rates to the Euler angles 
(for gyro inputs), 
transformation matrix 
from runway frame to 
inertial frame. 


TSTORE (only in FINDSCMP) 

Temporary scratch areas (matrices) in EKFN1 and BIASF 
Tmpl — real, mixed, (17,17) (-) (-) ; local working array 
Tmp2 — real, mixed, (17,17) (-) (-) ; local working array 
EKFN1, BIASF 


UPDQLC 

Saved local variables in subroutine UPDQ 

scalef — real, unitless ; s.d. of scale factor for rate gyro 

compensation 

spm — real, unitless ; average error variance for rate gyro 

compensation (includes scale factor and 
, misalignment errors) 

dt3 — real, s } saved dtime 3/3 
UPDQ 


YOBSRV 

Scaling array for the filter observations 

Yscale — real, mixed, (7) (3) (4) ; vector of scale factors used 

to scale each avgd . meas. 
into the NFF . Scaling is 
performed to ensure that the 
meas. noise variance is unity 
for each sensor, (indexed as 
per Table 6.2) 

INITG, SUMOUT, UPDH, UPDPH, RESCMP, ISOLAT, HEALR 
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